NAVAL POSTGRADUATE SCHOOL 

Monterey, California 




Underwater Multi-dimensional Path Planning for the 
Naval Postgraduate School Autonomous Underwater Vehicle II 

by 

Joseph Bonsignore, Jr. 

September, 1991 

Thesis Advisor: Yuh-jeng Lee 

Approved for public release; distribution is unlimited. 



125771 ^ 



UNCLASSIFIED 

CURITY CLASSIFICATION OF THIS PAGE 



a. REPORT SECURITY CLASSIFICATION UNCLASSIFIED 
a SECUR IT Y CLASS I F I CA TI ON AU T HOH fT? 



REPORT DOCUMENTATION PAGE 

1b. RESTRICTIVE MARKINGS 



3. DI5 T RIBU 1 I0WAVA I LABIL IT V OF REPOR T 
Approved for public release; 
distribution is unlimited 



b. DECLASSIPICATIONyDOWNCRADINC 3CWEDUIE 
. PERFOAMINS'ORCANIZATION REPORT NUMBERS) 



5. MONITORING ORGANIZATION REPORT NUMBER(S) 



a. NAME OP PERFORMING ORGANIZATION'' 
computer Science Dept. 

'Javal Postgraduate School 



eb. OFFICE SVMBOT 

(if applicable) 

CS(52) 



7a. NAME OF MONITORING ORGANIZATION 

Naval Postgraduate School 



c. ADDRESS (City. State, and ZIP Code) 

donterey, CA 93943 



7b. ADDRESS (City, State, and ZIP Code) 

Monterey, CA 93943-5000 



a. NAME OP FUNDIN&5P0N50RING 
ORGANIZATION 



tE/B FP re g SVMBOL ' 

(if applicable) 



5. PROCUR E M E N T I NS T RUMEN T IDEKI T IPICA T IOKI NUMBER 



16. SOURCE OF FUNDING NUMBEFtS" 



c. ADDRESS (City, State, and ZIP Code) 



PROGRAM 


TTOSCT 


TASk 


~wm unit — 


ELEMENT NO. 


NO. 


NO. 


ACCESSION NO. 



1. TITLE (Include Security Classification) 

Jnderwater Multi-dimensional Path Planning for the Naval Postgraduate School Autonomous Underwater Vehicle II 

RSONAL AUTHOR(S) 

)h Bonsignore, Jr. 



2TPE 

osepj 



&. TYPE QFREP.ORT 

✓Taster sThesis 



13b Time CovERed 


14. DATE OF REPORT (Year. Month. Day) 


15. PAGE COUNT 


from 9/89 TO 9/91 


September 1991 


151 



5. SUPPLEMEN T ARY HO T CTIOff 

lie views expressed in this thesis are those of the author and do not reflect the official policy or position of the Department of Defense or 
fie U.S. government. 



7. 



COS ATI CODES 



FIELD 


GROUP 


SUB-GROUP 















18. SUBJECT TERMS (Continue on reverse if necessary and identify by block number) 

Path planning, Path replanning, Tendril search, Wavefront search, Real-time A* search. 
Autonomous Underwater Vehicle, AUV, Ada in Artificiallntelligence. 



9. ABSTRACT (Continue on reverse if necessary and identify by block number) 

Traditionally path planning software has been developed in LISP or C. With the recent government mandate for the use of Ada, this thesis seeks to 

emonstrate the feasibility of using Ada for both path preplanning and real-time path replanning. Land vehicle path planning can be accomplished with two 

orizontal components. However, for autonomous underwater vehicles, the two horizontal components and a vertical component are required. Memory and 

Dmputational speed restrictions dictate that special processing of the search space be conducted to optimize the time-space trade-off. In this research, a four 

imensional array of nodes (two horizontal components, one vertical component and one orientation component) is used to represent the search space. By 

se of an orientation component, the number of nodes that can be legally moved to is limited, in effect pruning the search space. Three search methods were 

ivestigated: the Tendril search, the Direction search and the Real-time A* search. The Tendril search is a wavefront, breadth-first search. The Direction 

earch uses a vector field for path planning. The Real-time A* search uses the Tendril search to a specified search depth then applies a heuristic to determine 

ye best path to expand upon. 



5. Distribution/availability of abstract 

(3 UNCLASSIFIED/UNLIMITED Q SAME AS RPT. Q DTIC USERS 

2TF JAME OF R E SFO F ISIBL E IKIDIVIBUXT 

Yuh-ieng Lee 



SI! ABSTRACT SECURITY CLASSIFICATION' 
UNCLASSIFIED 



Co *' 



3VF755T 



D FORM 1473, 64 MAR 



83 APR edition may be used until exhausted 
All other editions are obsolete 



SECURITY CLASSIFICATION OF THIS PAGE 

UNCLASSIFIED 



Approved for public release; distribution is unlimited 



Underwater Multi-dimensional Path Planning 
for the Naval Postgraduate School 
Autonomous Underwater Vehicle II 



Joseph Bonsignore, Jr. 

Captain, United States Marine Corps 
B.S., The Virginia Military Institute, 1979 

Submitted in partial fulfillment of the 
requirements for the degree of 



MASTER OF SCIENCE IN COMPUTER SCIENCE 



NAVAL POSTGRADUATE SCHOOL 
September, 1991 



Robert B. McGhee, Chairman, 
Department of Computer Science 



by 



from the 






n 



ABSTRACT 



Traditionally path planning software has been developed in LISP or C. With the recent 
government mandate for the use of Ada, this thesis seeks to demonstrate the feasibility of 
using Ada for both path preplanning and real-time path replanning. Land vehicle path 
planning can be accomplished with two horizontal components. However, for autonomous 
underwater vehicles, the two horizontal components and a vertical component are required. 
Memory and computational speed restrictions dictate that special processing of the search 
space be conducted to optimize the time-space trade-off. In this research, a four 
dimensional array of nodes (two horizontal components, one vertical component and one 
orientation component) is used to represent the search space. By use of an orientation 
component, the number of nodes that can be legally moved to is limited, in effect pruning 
the search space. Three search methods were investigated: the Tendril search, the Direction 
search and the Real-time A* search. The Tendril search is a wavefront, breadth-first search. 
The Direction search uses a vector field for path planning. The Real-time A* search uses 
the Tendril search to a specified search depth then applies a heuristic to determine the best 
path to expand upon. 
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I. INTRODUCTION 



Autonomous underwater vehicle (AUV) research continues to grow as more 
applications are devised. From industry and scientific research to military applications, 
AUV technology has generated great interest. Currently, there are nearly 30 different 
organizations researching AUV technology, of which 18 are government funded [Busby 
and Vadus, 90]. This indicates the strong interest the government has in this technology. 

The benefits provided by unmanned autonomous vehicles are many. They provide a 
means to accomplish missions which are considered too dangerous for human involvement 
[Cloutier 90]. “Progress is aimed toward minimizing need for man’s physical presence, 
intervention underwater’’ [Busby and Vadus 90]. Underwater vehicles can be categorized 
as either tethered or autonomous [Rogers 89]. In contrast to a remotely operated vehicle 
(ROV), an AUV is not restricted by an umbilical which can hinder task performance in 
some cases. 

Due to the AUV’s nature, mission planning and execution are very complex problems 
to solve. Accurate world models must be made and complex path planning performed prior 
to mission execution. During task performance, continued evaluation of the many aspects 
of the mission must be performed. If necessary, adjustment or replanning must be 
conducted to insure successful mission completion or a decision to abort. 

A. OBJECTIVES 

This thesis intends to focus on path planning and replanning using the Ada 
programming language [Healey 90]. Several objectives are listed below: 

1. Implement a multi-dimensional Tendril search in Ada. 

2. Investigate the feasibility of waypoint utilization. 

3. Implement a Real-time A* (RTA*) path replanner in Ada. 

4. Investigate the feasibility of a vector field method of path planning. 
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5. Examine the feasibility of utilizing Ada reusable modules. 



B. BACKGROUND 

1. Naval Postgraduate School AUV II (NPS AUV II) 

The basic component layout of the NPS AUV II is illustrated in Figure 1-1. It is 
of aluminum box construction with a 16” beam, 10” height, 92” length and displaces 390 
pounds [Cloutier 90]. It uses eight independent control surfaces, four tunnel thrusters and 
two main screws, and has a top speed of two knots (three feet per second) with a 20 feet 




Sonar transducers Tunnel thrusters 



Drive motors 




NPS AUV n 
Figure 1-1 



2 



turning diameter. Power is provided by on-board lead-acid batteries with an approximate 
two and one half hour operating time [Floyd 91]. Current on-board systems include a 
GESPAC MPU 20HF board with Motorola 68020 and 68882 processors. OS - 9 was 
chosen as the operating system for its multi-tasking capabilities. As recommended by 
Bihari, a full GESPAC suite is expected to be used for its suitability to AUV applications 
[Bihari 90]. Appendix A and B are Data Flow Diagrams (DFD) and Software Heirachy for 
this project. 

2. Mission Planning Expert System 

The mission planning Expert System (MPES) is hosted on a Symbolics 3675 
LISP machine. Using the KEE expert system shell, it has four major components: the 
Mission Receiver, Mission Planner, Mission Constructor and Mission Executor. The 
Mission Receiver acts as the interface agent for user input. This information is passed to 
the Mission Planner which decides which path planning algorithm is best suited for the user 
supplied circumstances. Using various search technique including A*, and best-first search, 
the Mission Constructor does the actual path planning. The Mission Executor interfaces 
with the AUV/simulator and provides the appropriate mission data for execution. Figure 1- 
2 illustrates the MPES structure. [Ong 90] 

3. NPS AUV Simulator 

The NPS AUV II simulator contains a full set of submarine motion and 
hydrodynamics equations providing accurate, real-time simulation. Implemented on a SGI 
IRIS 4D/240 GTX graphics workstation, it displays a detailed underwater mapping of the 
Monterey Bay. Variable terrain resolution is used automatically to allow real-time 
operations. Its development is a joint effort between the computer science and mechanical 
engineering departments at the Naval Postgraduate School. [Jurewicz 90] 
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C. THESIS ORGANIZATION 



Chapter II reviews previous and current work in AUV technology. A detailed look at 
various path planning techniques is provided. 

Chapter III introduces the Tendril search. The original two dimensional and the 
expanded four dimensional version in LISP are examined. Several learning points from the 
task of translating the LISP program to Ada are reviewed. Limiting features of the four 
dimensional Tendril search are presented as well as a look into the feasibility of the Tendril 
bidirection search (TBS). 

Chapter IV presents a vector field approach to path planning with a discussion of 
advantages and disadvantages. 

Chapter V presents a real-time path replanner using the Real-time A* Search (RTA*). 
Many questions are posed and plausible justification for the use of the RTA* is presented. 

Chapter VI provides conclusions and recommendations for further research. Heavy 
emphasis is placed on the recommendations, which provide good insight to the perceived 
goals of the NPS AUV research. 
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Figure 1-2 Mission Planner Program Diagram 
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IL AUTONOMOUS UNDERWATER VEHICLE RESEARCH 



A. VEHICLE ARCHITECTURE 

1. Texas A&M 

Texas A&M University has made major contributions to AUV technology 
conducting feasibility research. Reliability and fault tolerance were the primary concerns, 
and no vehicle construction was intended. To accommodate this, 16 Sun Sparc stations, 
fully distributed, were used (fully loosely coupled). [Cloutier 90] 

Programmed in the C language, it incorporated nine embedded knowledge based 
systems (KBS). Some important findings resulted from this research. The use of a “watch 
team” knowledge base (KB) was overly centralized. This KB simulated the tasks and duties 
performed by a human team aboard Navy submarines. By its centralized nature, results and 
decisions were predictable, however, flexibility was reduced. There is a trade-off between 
flexibility and predictability which must be closely considered [Cloutier 90]. 

2. Naval Ocean Systems Center (NOSC) 

NOSC pioneered AUV research in the 1980’s after extended involvement with 
remotely operated vehicle (ROV) research since the 1960’s. NOSC has several on-going 
research efforts. Advanced unmanned search system (AUSS) was developed for search and 
survey. The free-swimming mine neutralization vehicle (FSMNV) is also under 
development. [Busby and Vadus 90] 

3. Massachusetts Institute of T echnology (MIT) 

The Massachusetts Institute of Technology developed Sea Squirt with funding 
from the National Oceanic & Atmospheric Administration and in cooperation with Draper 
Labs. It is a light weight, low-cost AUV primarily used as a test platform for intelligent 
algorithms. The research goal is to make a vehicle capable of operations in an adaptive 
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manner with respect to its environment in an uncharted area [Busby and Vadus 90]. 
Onboard systems include a GESPAC MPU - 20 board with a Motorola 68020 cpu and runs 
OS - 9, like the NPS AUV II [Bellingham 90]. 

4. Defense Advance Research Projects Agency 

The Defense Advance Research Projects Agency (DARPA) has been actively 
involved in AUV research. It has provided about 90% of the research funding throughout 
the research community and industry. As early as 1988, DARPA initiated projects with 
Draper Laboratory and Martin Marietta. These projects focused on the research and 
development of two vehicles and intelligence task research. Martin Marietta also planned 
to develop a “hard time” aspect to navigation that entailed planning a path where arrival 
times at specific way points are known before hand and met during execution. In 1989 
DARPA in conjunction with Lockheed Missiles and Space Company began development 
of an autonomous mine avoidance vehicle. [Busby and Vadus 1990] 

5. International Submarine Engineering 

Over the years, International Submarine Engineering, Ltd. (ISE) has developed 
several unmanned underwater vehicles (UUV). Its DOLPHIN was a diesel powered vehicle 
designed for offshore hydrographic mapping. The interesting aspect of this vehicle is the 
use of GESPAC components. After an extensive market survey, GESPAC was chosen for 
its price, performance, size, ruggedness and availability. [Zheng et. al. 90] 

B. PATH PLANNING 

1. General Path Planning 

The ultimate goal of a path planner is to derive a continuous set of free space 
points from the starting position to the goal position [Latombe 91]. For control of 
autonomous vehicles this can be done at various levels of resolution. A route planner is 
used at low resolution and a path planner provides a more specific solution to the path 
planning problem. In essence, the path planner provides a detailed path for the various path 
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segments generated by the route planner [Ong 90]. This thesis concentrates on the path 
planning resolution. 

Path planning is a well researched topic with many search techniques being used 
in various research efforts. Most commonly used methods are: Breadth-first, A*, Hill 
climbing, Depth-first and Best-first. Some of these will be presented later in this chapter. 

Important to note is the complexity of the search methods. As search space 
increases, some techniques, especially exhaustive methods, tend to be restrictive either due 
to memory or time requirements. Branching factor is an important aspect to consider. In a 
two dimensional search space there may be as many as eight adjacent nodes that the vehicle 
can legally move to as illustrated in Figure 2- 1 . With the addition of a third dimension these 
legal moves increase to 26 as illustrated in Figure 2-2. Methods are required to sufficiently 
reduce the branching factor to make these techniques viable. [Ong 90] 

2. Fast, Three-dimensional, Collision-free Motion Planning 

a. General Description 

Implemented in a nodal search space representation, this method successively 
divides the search space into homogeneous octrees or to a set resolution limit (section b 
below provides more detail on octrees). The less node division that is necessary, the easier 
for the path planner to process the search space. It is evident that planning a path in a search 
space with a small number of nodes is easier than to do so in a search space with a large 
number of nodes. [Herman 86] 

b. World Representation 

Upon initialization, the world is represented as a single node. If the node is 
not homogeneous (either wholly obstacle or free space) it is divided into eight children 
nodes. Each new node is evaluated for homogeneity and if necessary divided further. This 
process continues until all nodes are either wholly obstacles or free space, or the resolution 
limit is reached. A tree structure is formed with the original node as the parent and the 
resulting octree nodes as the children. 
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Figure 2-1 Two Dimensional Legal Moves 




Figure 2-2 Three Dimensional Legal Moves 
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c. Search Techniques 

Several search methods were incorporated in this method, to optimize time 
and memory use: 

1 . Hypothesis and Test, 

2. Hill Climbing, 

3. A*. 

The process started with the hypothesis and test method and switched to the hill climbing 
method. When local maxima were encountered the A* process was used to overcome them. 
Once past the local maxima, the program continued with the hill climbing process. 

d. Conclusions 

It is important to note that this method may not find the minimal cost path and 
only finds an adequate cost path. This may or may not be sufficient for some path planning 
needs. 

Another consideration is the use of several methods for path determination. 
The advantage of using multiple methods is to avoid “traps” such as local maxima that 
could stop a search from finding a path to the goal where one exists. Other individual 
methods may not encounter local maxima “traps” but may be time restrictive. Thus for 
timing considerations a less exhaustive method is used and the “traps” must be considered. 
By malting this time trade-off, other methods are required where one method may fail. 
Although acceptable, using multiple methods adds to the complexity of the problem and 
appears to provide little overall advantage in computational speed. 

3. Bidirectional Staged Heuristic Search (BS*) 

a. General Description 

This technique can use any of the basic methods listed in the first paragraph 
of this chapter. What makes this approach unique is how that basic method is used. BS* is 
actually two searches: one starting at the starting point and working towards the goal, the 
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other starting at the goal and working towards the starting point. After each iteration a 
“wave” of acceptable moves is generated for each search. When the two waves meet at a 
connecting point a path from the starting point to the goal is completed. Figure 2-3 
illustrates the BS*. [Kwa 89] 



Wave front for START to GOAL search 




Figure 2-3 Bidirectional Search Process 
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b. Trees 



As the search expands on a node finding its subsequent legal moves, a tree- 
like structure is generated. Here the branching factor becomes a problem: the trees grow 
exponentially. Various methods, like pruning and trimming have been used to reduce the 
size of the trees and provide more efficient processing. It has been proposed that generating 
two trees, vice one, reduces the total effort of processing the search space. Therefore, by 
dividing the search process into two halves (start-to-goal, and goal-to-start) the trees 
generated are overall smaller than that generated by a single direction search. [Kwa 89] 

c. Cost 

With the reduction of tree size and search space, it would be logical to assume 
the process to require less time to generate a path. This, however, is not the case. After each 
iteration a check must be made to determine if the two search halves have met. This check 
can be a costly process and may not reduce overall computational time. 

Other researchers have tried to “push” or “nudge” the search tree growth 
along an expected path and thereby reduce the number of “open” nodes. This, however, can 
lead to a non-admissable solution to the problem and a less then optimal path may be 
generated. Kwa uses nipping, pruning, trimming and screening to help reduce the number 
of open nodes and reduce run-time. Nipping, pruning, trimming and screening are 
techniques used to eliminate paths that are obviously too costly. 

d. Advantages and Disadvantages 

The most noteworthy advantage is that this method can be executed on a 
parallel processing computer. With a multi-processor system such as the T-800 transputer, 
each processor could perform a search. Taking this one step further, consider a path with 
an intermediate way-point as indicated in Figure 2-4. A multi-processor system could 
process each path segment (start-to-waypoint, waypoint-to- start, goal-to-waypoint, 
waypoint-to-goal) on different processors. The same problem of checking for the 
connecting point is still unavoidable. 
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Figure 2-4 Bidirectional Search Process with Waypoint 
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4. Configuration Space (C-space) 

a. General Description 

The underlying assumption of C-space path planning is that it is easier to plan 
for a point size vehicle then for a rigid body vehicle. By reducing the vehicle representation 
to a point, the world model must be altered so that a safe path can be planned. How the 
world is changed is the interesting aspect of this technique. [Warren 90] 

b. C-Space Obstacles 

Since the rigid body vehicle is represented as a point something must be done 
to insure a safe path is planned [Lozano-Perez 83]. To accomplish this, obstacle size is 
altered to reflect a vehicle size buffer as shown in Figure 2-5 [Latombe 91]. It is important 
to note that obstacle buffer size varies depending on the vehicle orientation. Each 
orientation specific obstacle is called a shield and can be calculated at run-time to reduce 
preprocessing workload. [Latombe 91] 

c. Conclusion 

C-space obstacle representation may be good where very precise navigation 
is necessary. Calculations for vehicle representation are reduced by representing the 
vehicle as a point but computational time is increased by the requirement for calculating 
the shields for each orientation. The four-dimensional Tendril search uses a very simplified 
C-space concept. Orientation is limited to the four cardinal headings and each node is 
represented by four shields. 

5. Potential Field 

a. General Description 

Given a girded or nodal search space, potentials are assigned to each node. 
These potentials are based upon proximity of a node to the goal or an obstacle. Nodes with 
obstacles in close proximity will have a repulsion potential since it is undesirable to 
position a vehicle in these nodes. Other nodes provide a free and clear path to the goal and 
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thus are assigned an attraction potential. Once the potential field is established any search 
technique can be used to find the least cost path. [Warren 90] 




Figure 2-5 Expanded C-Space Obstacle for a Vehicle with Fixed Orientation 



b. World Representation 

Figure 2-6 shows how a potential field can be represented. Free space is 
assigned a potential based on the square of the distance from the goal. Nodes near obstacles 
are assigned a potential based on the reciprocal of the distance from the obstacle, squared. 
After preprocessing the search space, assigning potentials, a topology or landscape is 
developed that allows a vehicle to travel “downhill” to the goal. [Warren 90] 
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c. Conclusion 



Again, local maxima can cause a problem by “trapping” the search. Figure 2- 
6 displays this and indicates the need for an alternate search method. In the figure, the 
shortest path would be along the diagonal between the start and goal. The potentials, 
however may drive the path in a less optimal direction or worse; trap the path at the local 
maxima. The Direction search incorporates the potential field concept at a very abstract 
level. Values are not assigned to each node, however, a “pointer” to the next node in the 
shortest path to the goal is stored at each node in the search space. 

6. Remarks 

Each of the techniques presented have been researched well and the use of 
multiple methods has been explored, yet combination of techniques in a single search is 
somewhat rare. Each has its merit and could easily be incorporated in varying degrees of 
complexity to produce an efficient path planner. The search techniques to be presented in 
the following chapters use some variation of these techniques. The predominant difference 
from previous research is that some of these techniques are combined into a single search 
process. 
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Figure 2-6 Example Potential Field Representation 
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in. THE TENDRIL SEARCH 



A. GENERAL 

In the Tendril search, the search space is represented by an multi-dimensional array, 
or lattice of nodes. Each node maintains several attributes to facilitate the path planning 
process. One of the attributes is a list of the node’s immediate neighbors, with an associated 
cost to move to each neighbor. Only non-obstacle neighbors are maintained in this list and 
represent the legal moves that can be made from the node. The legal moves from the 
starting point represent the first WAVE. Legal moves are found for each node of this 
WAVE and the process continues generating subsequent waves until the goal is reached. 

B. LISP VERSION 

1. Two Dimensional Problem 

Originally written for a two dimensional search space [McGhee 90], there are 
eight potential legal moves (one for each cardinal direction and one for each diagonal 
move) that can be made from the starting point These legal moves are placed in an “open” 
list, WAVE, of nodes to be expanded upon. The next wave is determined by finding the 
legal moves for each node in the WAVE list. As each node is processed it is assigned a 
tendril length representing the length of the current path from the start to that specific node. 
There is an exponential increase in the number of nodes for each wave which could cause 
limitations due to memory requirements. Since individual nodes can be reached via 
multiple paths, it is important to consider each one so the shortest can be selected. By 
pruning previously processed nodes whose assigned tendril length is less than that of the 
current waves calculation for the tendril length, the longer and redundant paths are 
eliminated. This specifies that the node can be reached by a shorter path and the current path 
need not be investigated. The pruning process helps to reduce the time required to 
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preprocess the search space. Even so, preprocessing of the search space for each node’s 
legal successor is not feasible, especially for real-time constraints. 

2. Four Dimensional Problem 

When a third dimension (depth) is considered, the problem becomes very 
complex. Each node has 26 possible legal moves. This is unacceptable if real-time path 
planning is needed. To reduce this number an additional dimension is considered, heading. 
It is not unreasonable and is only natural to consider orientation when planning a path. Only 
the cardinal headings (North, East, West and South) are considered in this program. Since 
a vehicle must have a heading the number of legal moves can be reduced to nine as shown 
in Figure 3-1. Thus the two dimensional problem is easily expanded to four dimensions 
with little increase in computational complexity. More details of this program are found in 
[Bonsignore 90]. Appendix C lists the four Dimensional LISP code (3dh.lisp). 

C. ADA VERSION DESCRIPTION 

1. General 

“Why use Ada?” is a question surely posed by some researchers. Through a recent 
mandate, the government requires the use of Ada for its software projects. This, however, 
is not the driving force behind the use of Ada for this thesis. Ada was designed for use in 
large programming projects. With characteristics such as separate compilation and generic 
procedures, it facilitates the modularization of programming projects and allows several 
programmers to work individually. Modularity also helps with program maintainability. 
Ada provides multitasking and timing constructs which facilitate real-time systems 
programming [Voltz, et al 84], All of these attributes make Ada especially suitable for 
AUV programming. 

The initial intent of this thesis was to build a path planner with Ada reusable code. 
Some difficulties with reusable code were encountered. The Ada software repository at 
White Sands Missile Range is not quite “user friendly”. Very general procedures, such as 
building linked lists, were acceptable. More sophisticated code, however, was often 
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difficult to find. Some of these procedures were not stored with “user friendly’’ file names 
and often stored with coded names, making quick access difficult. Even when the 
appropriate code was obtained and the module found to be usable, many modifications 
were required. On large projects these modifications and subsequent testing may be more 
costly then writing the procedures from scratch [Gaffney 89]. For these reasons this thesis 
does not take advantage of reusable Ada software. 

2. Direct Translation 

An initial attempt at programming in Ada was made by making a direct 
translation from LISP. All the LISP structures and functions were translated into Ada 
records and procedures. This task was not easy since the two languages are very different. 
Many modifications, although small, were required in the Ada code due to these language 
differences. 

a. Memory Problem 

A major difficulty with the direct translation was that of memory usage. The 
LISP version preprocesses the search space assigning a list of possible legal moves from 
each node. In a two dimensional problem there are eight legal moves for each node (the test 
search space is a 10 x 20 array resulting in approximately 1600 legal moves). The memory 
requirement for this can be too large for some systems (as was the case for a modestly 
configured 386SX). Preprocessing is wasteful since nodes that do not require processing 
were processed anyway. These problems were solved by modification in the Ada version 
which will be presented in subsequent sections of this chapter. 

b. Speed 

Due to the extensive search process requirements, the speed at which the 
LISP version ran was slow. The directly translated Ada version did not run at all due to 
system memory constraints, therefore no timing characteristics are available. 
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3. Four Dimensional Problem 

Expanding the two dimensional problem to incorporate depth and heading 
drastically increased memory requirements since the number of legal moves over tripled 
resulting in a combinatorial explosion. As earlier stated, this was solved by considering 
only those moves that the vehicle can immediately transition to when the vehicles heading 
is taken into account. By considering orientation in the search process unnecessary path 
searches were eliminated. 

4. Modifications 

Many modifications were required to enable the four dimensional Ada Tendril 
search to run. Some changes were very simple and others required a complete rewrite to 
achieve the efficiency required. Appendix D is a data dictionary, DFD, and code for this 
process. 

a. Smaller records 

The LISP version record structure for a node maintained a list of all legal 
moves possible from that node. By eliminating this attribute the size of the record was 
substantially reduced thus easing the limitations imposed by memory restrictions. Section 
b. below describes how the legal moves are determined. 

b. “FJdOVES” 

To reduce memory requirements the preprocessing of the search space was 
eliminated. Instead, the legal moves were determined as each node was reached in the 
search process. Thus if looking for a path between two adjacent nodes the legal moves for 
the nodes far removed from the possible path are not determined. Listed below, is the 
pseudo-code representation of this process. 

procedure F_MOVES (N_ARRAY : in out NODE.ARRAY; 

ROOT : in out LIST_PTR) is 
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HEADING : INTTYPE := ROOT.LOC(4); 



begin 

case HEADING is 
when the heading is north=> 
check the upper northwest node 
check the upper north node 
check the upper northeast node 
check the northwest node 
check the north node 
check the northeast node 
check the lower northwest node 
check the lower north node 
check the lower northeast node 
when heading east => ... 
when heading south =>... 
when heading west =>... 
when others => 
null; 

end case; 
end F.MOVES; 

procedure F_PATH (N.ARRAY : in out NODE_ARRAY) is 
ROOT : LIST.PTR := WAVE; 
begin 

while the root contains valid information loop 
F_MOVES (N_ARRAY, ROOT); 

ROOT := WAVE.NEXT; 
end loop; 

if the goal is found then 
return to the main process (DO_SEARCH) 
end if; 

end F_PATH; 



F_MOVES, called from within F PATH, takes as input the search space (N_ARRAY) and 
the current node being processed (ROOT). Using the ROOT’S heading the nine legal moves 
are determined. Each legal move is processed and if the GOAL is among them, the search 
is complete, otherwise they arc assigned to a list called WAVE. The legal moves for each 
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node in WAVE are then generated and the process of checking for GOAL is repeated. This 
continues until the goal is found or all nodes are processed without reaching the GOAL. 

c. Waypoint capability 

It is conceivable that an AUV may need to navigate to some intermediate 
points that may not be along the optimal path between the start and goal. For this reason a 
waypoint capability is required. The algorithm below illustrates the TENDRIL WP search 
in pseudo-code which allows multiple waypoint path generation. 



procedure TENDRILWP is 
begin 

GET.DATA; 

DO.SEARCH; 
end TENDRILWP 

procedure GET_DATA is 

begin 

while there are still points to enter loop 
get way point cooidinates 
exit when done 
end loop 

procedure DO_SEARCH is 
begin 

read in the terrain data 
create the output file 
loop 

exit when the second node in WAVE is null 
while WAVE is not empty and the goal isn’t found 
F_PATH 
end loop; 
print the path 

reset the search space and variables to initials values 
end loop 

close the output file 
end DO_SEARCH 
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The tendril search technique is used in each path planning segment. A “while... loop” 
construct was added to the DO_SEARCH procedure (in the PATHWP package). Each 
waypoint is processed in order, finding a path between each of two successive points. The 
generated path segment is printed to a file and the next two points are processed until 
complete. Upon completion of a path segment many variables need to be reset to their 
initial values to allow the next path segment to be generated. The RESET_ALL procedure 
resets global variables. 

This path planning technique divides the search into several small searches 
lending itself to concurrent processing. While one processor finds a path from the start to 
the waypoint, another processor could find the path from the waypoint to the goal. This 
version does not take advantage of concurrent processing, it finds each path segment 
sequentially. Appendix E contains the Data Dictionary, DFD and program code. 
Limitations 

As previously indicated, memory and speed have continued to be a concern in this 
methods efficiency [Richbourg et. al. 87]. If the whole search space needs to reside in 
memory, it is restricted by the machines capabilities. If time constraints permit, reading and 
writing to a file may be a feasible solution. This aspect was not investigated in this thesis. 
It is interesting to note that as the obstacle density increases, a larger search space can be 
stored in memory without causing memory problems. This is a result of “pruning” the 
obstacle nodes from the legal move and open node lists. As the number of obstacle nodes 
increases the free space is logically decreased. 

5. The Tendril Algorithm 

The Tendril search takes as input the starting coordinates including orientation 
(row, col, dep, hdg) and the goal. Terrain data is read from a file and is implemented in a 
dynamic array described by the first few items (array dimensions) read from the file. From 
the starting point and consistent with the initial heading, the legal moves are determined 
and assigned to WAVE. Each node in WAVE is assigned a parent node (in this case the 
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parent is the starting point) and its tendril length is calculated from the tendril length of the 
parent plus the distance from the parent to that node. Checks are made to ensure nodes 
previously processed are not reprocessed unless the resulting tendril length is shorter than 
the nodes current tendril length. This process is performed on each node in WAVE which 
generates another wave. Iteratively, it continues until a wave reaches the goal. Once the 
wave containing the goal is fully processed, the program stops the search and backtracks 
from the goal, via its parent “pointer” to the start, printing out the path (or writing it to a 
file). Listed below is the pseudo-code of the Tendril search. 



procedure TENDRIL is 
begin 

GET_DATA; 

DO.SEARCH; 
end TENDRIL; 

procedure GET_DATA is 

begin 

get the terrain file name 
get array data 

get START and GOAL coordinates 
end GET.DATA 

procedure DO_SEARCH is 

begin 

get the terrain data 

while the WAVE list is not empty loop 
F_PATH 

exit when the goal is found 
end loop; 
print the path 
end DO.SEARCH 



As previously described the F_MOVES procedure performs most of the work. It 
checks for the ROOT’S heading and uses a case statement to handle each of the cardinal 
headings. For example, when the vehicle is heading north (HDG =1) only the nine nodes 
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in a northerly direction are evaluated. These evaluations are performed in the 
THE_MOVES package. Each CHECK_ NODE (where NODE represents one of the nine 
legal moves) procedure determines the coordinates of the legal node being evaluated and 
calls the CK_STATE procedure. In CK_STATE the node’s state is determined to be either 
free space or obstacle space. If the node is free space, the GROW_TEND process is called. 
This process adjusts the tendril length, assigns the parent (ROOT), and attaches that node 
to the NEW_WAVE list. Other procedures are used to process the WAVE and 
NEW_WAVE lists in support of the F_MOVE procedure. 

D. TENDRIL BIDIRECTIONAL SEARCH 

1. Concept 

Although not implemented in this research the Tendril Bidirectional search (TBS) 
appears to be a viable solution to real-time processing problems. This method lends itself 
well to concurrent processing as previously described for the Tendril search with 
waypoints. With the installation of a T-800 transputer board into the NPS AUV II, 
concurrent processing is highly desirable and achievable. 

2. Limitations 

An important consideration is the need to check for completion after each wave 
iteration. This could be a difficult problem, reducing the advantages of concurrency by 
requiring a high degree of communication between each search process. 

E. EVALUATION AND RESULTS 

For ease of comparison, a smaller terrain representation was used in the evaluation (5 
rows X 5 columns X 5 depths X 4 headings). When tested with an obstacle free model, the 
paths generated in both the Ada and LISP (compiled) versions were identical. The Ada 
code was much faster (.24 seconds vice .933 seconds for LISP). It is especially significant 
considering the following facts: While the LISP version has the terrain data hard coded, the 
Ada version must open and read the data from a disk file. The Ada version writes its results 
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to the screen and to a file. Both of these differences are I/O processes which are time 
intensive. Even with these I/O hindrances the Ada version was the fastest. In an obstacle 
intense terrain model, results were similar. 
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IV. VECTOR FIELD METHOD 



A. GENERAL DESCRIPTION 

Although a very simple process, this method has proven to be the most efficient of 
those investigated in this thesis. Listed below, is the pseudo-code for the DIRECTION 
procedure. 



procedure DIRECTION is 
begin 

GET_DATA 
DO_DIR 
end DIRECTION 

procedure GET_DATA is 

begin 

get the terrain file name 
get array data 

get START and GOAL coordinates 
end GET_DATA 

procedure DO_DIR is 

begin 

get the terrain data 
FIND_MOVES 
FIND_PATH 
P_PATH 
end DO_DIR 



The legal moves are determined by searching backwards from the goal. The node attribute, 
NEXT, stores the coordinates of a successor node having the shortest distance to traverse. 
As legal moves are determined the NEXT attribute is assigned the coordinates of the node 
being expanded. Therefore the nodes generated from the goal will have the goals 
coordinates stored in the NEXT attribute. Figure 4-1 illustrates the backwards search 
process and direction assignment for a three dimensional problem (row, column, and 
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heading) with the GOAL having a southerly orientation. The numbers in each node 
represent the order that they were processed during the search. Two nodes adjacent to the 
GOAL remain unassigned because it is impossible for these nodes to move directly to the 
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Figure 4-1 Representation of a Vector Field 



GOAL with the proper orientation. This is not the case in the four dimensional problem 
(including depth). A transition in depth will allow all paths to the GOAL to be generated. 

Nodes are processed with a priority. A move not requiring a heading change is 
less expensive than moves that do. Nodes are put into a search queue based on the cost to 
move into the next node. The entire search space is processed this way, resulting in 
“vectors” being assigned to every free space node. Once the starting point is entered, all 
moves to the goal are immediately available. 
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B. ADVANTAGES AND DISADVANTAGES 



The most obvious advantage is the speed at which this process runs as compared to the 
Tendril search. To find a path, the user provides the starting point. Each individual node 
“knows” its next move to reach the goal. Path determination is just a matter of following 
the NEXT attributes until the goal is reached. No calculations are required during the path 
planning process making it very fast. 

Other searches need both the starting point and the goal to preprocess the search 
space. The Direction process needs only the goal to prepare the search space. Since the 
preprocessing is not dependent on the starting point, many trials with various starting points 
can be investigated with only the cost of the preprocessing once. 

Another advantage is the ease at which obstacles are handled during the process. 
Originally written for only non-obstacle terrain, a small modification was required to 
handle obstacles (i.e. an obstacle is an illegal NEXT move). 

As can be seen in Figure 4-1, all the paths to the GOAL may not be generated. If the 
starting point is the node just to the right of the GOAL, a path may not be found (where one 
exists) to reach the GOAL with the appropriate orientation (southerly heading). This 
disadvantage can be overcome when considering a four dimensional problem. 

C. BASIC PROGRAM FLOW 

Similar to the Tendril search, terrain, starting point and goal information are taken as 
input. Some of the procedures are exactly the same as those used in the Tendril search, 
while others required minor modifications. Most notably is that FIND_MOVES procedure 
processes legal moves in “reverse” from the F_MOVES procedure in the Tendril search. A 
pseudo-code version of this procedure is listed below. It finds all the legal moves from 
which the goal can be reached as opposed to which node can be move into from the starting 
point. The legal moves are placed into a queue of active nodes, ACTIVE, based upon a 
predefined order relative to heading. The ordering results in the nodes with the least cost 
being at the head of the queue and the rest follow in increasing cost order. Each member of 
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the ACTIVE queue is processed in a similar manner with its legal moves being appended 
to the end of the queue. As each node is processed its NEXT attribute is assigned the 
coordinates of its parent. This is, essentially, a pointer to the shortest move to attain the 



procedure FIND_MOVES (N_ARRAY : in out NODE_ARRAY) is 

heading : INT_TYPE := ACTIVE.LOC(4); 
list : LOC_ ARRAY := ACTIVE.LOC; 
new Jist : LOC.ARRAY := ACTIVE.LOC; 

begin 

while the ACTIVE list is not empty loop 
heading := ACTIVE.LOC(4); 
list := ACTIVE.LOC; 
new_list := ACTIVE.LOC; 
case heading is 
when heading north => 
check the southern node 
check the upper south node 
check the lower south node 
check the southeast node 
check the upper southeast node 
check the lower southeast node 
check the southwest node 
check the upper southwest node 
check the lower southwest node 
when heading east => ... 
when heading south => ... 
when heading west => ... 
when others => 
null 

end case; 

end FIND.MOVES; 



goal. Processing the entire search space results in every free space node being assigned a 
NEXT node to move to and a cost associated with that move. Obstacles are not processed 
and a NEXT move cannot be assigned the coordinates of an obstacle. The A_AND_A 
(analyze and assign) procedure insures the assignment of the NEXT attribute is done 
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properly. The P_PATH process generates the path. Beginning with the starting node, it 
follows the NEXT “pointers” until the goal is reached and writes the nodes to a file. 
Appendix E contains the Data Dictionary, DFD, and program code. 

D. THE DIRECTION SEARCH ALGORITHM 

Producing most of the work for this technique is the, previously mentioned, 
FIND_MOVES procedure. Having passed in N_ARRAY (the array of nodes) it uses the 
GOAL and a case statement to determine legal moves. It is very similar to the F_MOVES 
procedure in the Tendril search except that it works in “reverse.” Looking at the orientation 
required in the GOAL, it determines what node an AUV can transition from to attain that 
GOAL. Procedures in the THE_MOVES package then determine the coordinates of these 
nodes and calls the A_AND_A procedure (analyze and assign). In this procedure it is 
determined if the nodes are free or obstacle space. If a node is free space it is assigned a 
value, DIST, equal to the distance that must be traversed to enter that node. It is also 
assigned to the ACTIVE queue in a specified order as previous detailed. Other procedures, 
similar to the Tendril search, are supporting means for processing the ACTIVE list. 

E. RESULTS AND EVALUATION 

Similar to the timing results of the Ada version of the Tendril search, the Direction 
search is significantly faster then the LISP Tendril search. The results of a search conducted 
in an obstacle free space produced similar results, although slightly faster (.2271 seconds 
vice .233 for Ada Tendril). This timing variance may be explained by I/O differences. A 
significant timing difference was noted between the searches in an obstacle intense 
environment. The Direction search was much faster (.11 seconds vice .329 seconds). This 
is attributed to the different way obstacles are handled in the two programs. The Direction 
search has much less overhead for handling obstacles. 
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V. PATH REPLANNING 



A. GENERAL DESCRIPTION 

A path replanner is a path planner with more stringent time constraints. It is needed 
when an AUV is required to circumnavigate an unexpected obstacle to continue its mission. 
This replanner must, therefore, operate in real-time to facilitate an efficient transition to an 
alternate path. 

The Real-time A* (RTA*) algorithm presented by Korf [Korf 88] was modified to 
incorporate four dimensions. This method can use any of the previously mentioned 
techniques for searching (Best-first, Tendril, etc.) but only searches to a specified search 
depth. Nodes at the search depth are called frontier nodes.The method implemented in this 
thesis uses the Tendril search to a search depth of three nodes. As the search progresses, the 
cost of reaching the frontier nodes is calculated. Adding this cost to an estimate to reach the 
goal, the frontier node with the lowest overall cost is chosen to be expanded upon. The 
process is repeated at this intermediate frontier node and successively until the goal is 
reached. Appendix F contains the Data Dictionary, DFD and program code. Pseudo-code 
for the RTA* search is listed below. 

procedure RTA is 
begin 

GET_DATA 
DO.SEARCH 
end RTA 

procedure DO_SEARCH is 
begin 

get the terrain data from file 
while the goal is not found loop 
find the frontier nodes 
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pick the node with the estimated least cost 
end loop 
print the path 
end DO_SEARCH 

B. JUSTIFICATION 

Previously presented search methods may not be efficient enough for real-time path 
replanning. As a possible solution to this problem, the RTA* technique was investigated. 
Due to the nature of the AUV’s working environment it is feasible to “expect the 
unexpected.” The dynamic nature of the undersea environment can alter terrain and 
obstacles swiftly, rendering preprogrammed paths obsolete. For this reason an on-board 
replanner is required which must operate in real-time. 

Many considerations went into the implementation of the RTA* for this thesis: 

1. What search method should be used to find the frontier nodes? 

2. What should the search depth be? 

3. Would the old path be completely disregarded or should a new path try to return to the 
old path as soon as possible? 

4. Should this procedure handle the initial collision avoidance maneuver? 

5. How “real” is real-time? 



These questions had to be properly answered to produce a true real-time path 
replanner. Since this thesis predominately examined the Tendril search, it was determined 
that it should be used for the search method in the RTA*. The search depth was arbitrarily 
chosen at five nodes and later reduced to three because of memory limitations. Old path 
data is discarded and the new path does not attempt to “get back on” the old path. Initial 
collision avoidance is to be performed by a different procedure and this RTA* would be a 
path replanner only. Strict real-time constraints have not been set. 
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C. DISADVANTAGES 



Although good for two dimensional problems, the RTA* is very memory intensive for 
multi-dimensional problems. As waves arc processed the legal moves for all nodes up to 
the search depth must be retained. To illustrate the exponential growth of search nodes, 
consider a starting point that has only three legal moves in its first frontier. At a two node 
frontier distance (or second frontier) 27 legal moves must be maintained and 243 legal 
moves at a three frontier. A combinatorial explosion results with further processing. For a 
moving vehicle, a three node length look ahead capability may be insufficient (depending 
on node size) for obstacle avoidance reaction time. 

D. EVALUATION 

Due to the massive memory requirements, this process appeared to be fruitless 
especially when the good results of the previously presented methods are considered. Upon 
a second consideration, it is feasible to incorporate pruning methods to help eliminate 
unnecessary processing of nodes which should not be processed. Pruning techniques were 
successfully used in the other methods and therefore should not be difficult to implement 
into the RTA* search. Further research with this method is recommended. 
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VI. CONCLUSIONS AND RECOMMENDATIONS 



A. SUMMARY AND CONCLUSIONS 

This thesis investigated several path planning techniques using a nodal representation 
of the search space. A four dimensional Tendril search was implemented in Ada and a time 
comparison to a LISP version was made. The results indicate that it is feasible to use Ada 
for intelligent, real-time path planning. One version of the Tendril search incorporated a 
waypoint capability. It is an important aspect that should be looked at more carefully for 
implementation in the NPS AUV II. 

The Direction search, using a vector field was implemented. This method proved to be 
the fastest of the methods investigated. Due to its speed and simplicity, it is highly 
recommended for the NPS AUV II replanner for the near term. 

The RTA* search initially appeared to be cumbersome for multi-dimensional path 
replanning. Upon reconsideration, it could be modified to take advantage of pruning 
techniques to eliminate unnecessary node processing. 

B. RECOMMENDATIONS 

Each method of path planning investigated was valuable for various reasons. 
Simplicity was the prevailing aspect in all methods which, in turn, resulted in small time 
requirements for search space processing. Of these procedures the Direction search was the 
simplest and fastest, thus recommended for further research to incorporate into the NPS 
AUV II as the onboard path replanner. 

It should be noted that there are limited orientation capabilities for each method. 
Although only the cardinal headings were used, the results are sufficient for path-planning 
purposes. The guidance module of the NPS AUV II does not use the orientations produced 
in the path planning process. It uses only three dimensional coordinates, generating 
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orientation more accurately itself. Thus, the course orientations of these path planners are 
only for their internal use to accommodate more accurate planning. [Magrino 91] 

The use of waypoints is a very important feature of path planning, whether for an 
aircraft, AUV, or a trip to the comer market. Use of the Direction search with a waypoint 
capability is recommended for further research. It may be difficult or time restrictive since 
the vector field generated depends on the goal. A new vector field is required for each path 
segment. Consideration should be given to dividing the search space into portions, each 
path segment having its own portion of the search space eliminating the requirement to 
reinitialize the entire search space after each path segment is planned. 

The Tendril Bidirectional Search (TBS) lends itself to concurrent processing. The use 
of transputers could make this an exceptional method for real-time path planning. 

Consideration should be given to the use of multiple path planning and replanning 
methods. Planning for obstacle intense environments is significantly different from 
obstacle sparse environments. In most cases it appeared that the easiest path to plan (no 
obstacles) took the longest time. The Mission Planning Expert System has the capability to 
determine appropriate planning methods yet it has very few methods implemented. Further 
research is required to build upon the MPES path planning methods. 
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APPENDIX A - Data Flow Diagram for the NPS AUV II 
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APPENDIX B - 

NPS AUV II System Block Diagram 
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APPENDIX C 

Three Dimensional Tendril Search in LISP 

defstruct node state parent tendril-length link-list) 

(defvar *new-active-node-list* nil) 

(defvar *active-node-list* nil) 

(defvar *goal* nil) 

(defvar *goal-flag* nil) 

(defvar *node-array* (make-array ‘(6 7 7 7))) 

(defvar *cycle-number* 0) 

(defvar * terrain* (make-array ‘(6 7 7 7) rinitial-contents (ommitted) 

(defun create-node (h k i j) 

(setf (aref *node-array* h k i j) (make-node))) 

(defun initialize-state (h k i j) 

(if (= 1 (aref *terrain* h k i j)) 

(setf (node-state (aref *node-array* h k i j)) ‘obstacle))) 

(defun set-state (heading depth row column state) 

(setf (node-state (aref *node-array* heading depth row column)) state)) 

(defun set-parent (heading depth row column parent) 

(setf (node-parent (aref *node-array* heading depth row column)) parent)) 

(defun set-tendril-length (heading depth row column length) 

(setf (node-tendril-length (aref *node-array* heading depth row column)) length)) 

(defun set-link-list (heading depth row column list) 

(setf (node-link-list (aref *node-array* heading depth row column)) list)) 

(defun state (heading depth row column) 

(node-state (aref *node-array* heading depth row column))) 

(defun parent (heading depth row column) 

(node-parent (aref *node-array* heading depth row column))) 

(defun tendril-length (heading depth row column) 

(node-tendril-length (aref *node-array* heading depth row column))) 

(defun link-list (heading depth row column) 

(node-link-list (aref *node-array* heading depth row column))) 
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(defun make-terrain (heading-size depth-size row-size column-size) 

(dotimes (h heading-size ‘terrain-initialized) 

(dotimes (k depth-size) 

(dotimes (i row-size) 

(dotimes (j column-size) 

(create-node h k i j) 

(initialize-state h k i j)))))) 

(defun legal-fwd-connected-link-list (heading depth row column) 

(non-nil-cons (4-link heading depth (1- row) column) 

(non-nil-cons (diag-link-ul 2 depth (1- row) (1- column)) 

(non-nil-cons (diag-link-ur 4 depth (1- row) (1+ column)) 

(non-nil-cons (diag-up-link-ul 2 (1- depth) (1- row) (1- column)) 

(non-nil-cons (diag-up-link-u heading (1- depth) (1- row) column) 

(non-nil-cons (diag-up-link-ur 4(1- depth) (1- row) (1+ column)) 

(non-nil-cons (diag-down-link-ul 2 (1+ depth) (1- row) (1- column)) 
(non-nil-cons (diag-down-link-1 heading (1+ depth) (1- row) column) 
(non-nil-cons (diag-down-link-ur 4 (1+ depth) (1- row) (1+ column)) nil)))))))))) 

(defun legal-left-connected-link-list (heading depth row column) 

(non-nil-cons (4-link heading depth row (1- column)) 

(non-nil-cons (diag-link-ul 1 depth (1- row) (1- column)) 

(non-nil-cons (diag-link-11 3 depth (1+ row) (1- column)) 

(non-nil-cons (diag-up-link-ul 1 (1- depth) (1- row) (1- column)) 

(non-nil-cons (diag-up-link-1 heading (1- depth) row (1- column)) 

(non- nil-cons (diag-up-link-11 3 (1- depth) (1+ row) (1- column)) 

(non-nil-cons (diag-down-link-ul 1 (1+ depth) (1- row) (1- column)) 
(non-nil-cons (diag-down-link-1 heading (1+ depth) row (1- column)) 
(non-nil-cons (diag-down-link-11 3 (1+ depth) (1+ row) (1- column)) nil)))))))))) 

(defun legal-back-connected-link-list (heading depth row column) 

(non-nil-cons (4-link heading depth (1+ row) column) 

(non-nil-cons (diag-link-11 2 depth (1+ row) (1- column)) 

(non-nil-cons (diag-link-lr 4 depth (1+ row) (1+ column)) 

(non-nil-cons (diag-up-link-U 2 (1- depth) (1+ row) (1- column)) 

(non-nil-cons (diag-up-link-d heading (1- depth) (1+ row) column) 

(non-nil-cons (diag-up-link-lr 4 (1- depth) (1+ row) (1+ column)) 

(non-nil-cons (diag-down-link-11 2 (1+ depth) (1+ row) (1- column)) 
(non-nil-cons (diag-down-link-d heading (1+ depth) (1+ row) column) 
(non-nil-cons (diag-down-link-lr 4 (1+ depth) (1+row) (1+ column)) nil)))))))))) 

(defun legal-right-connected-link-list (heading depth row column) 

(non-nil-cons (4-link heading depth row (1+ column)) 
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(non-nil-cons (diag-link-lr 3 depth (1+ row) (1+ column)) 

(non-nil-cons (diag-link-ur 1 depth (1- row) (1+ column)) 

(non-nil-cons (diag-up-link-lr 3 (1- depth) (1+ row) (1+ column)) 

(non-nil-cons (diag-up-link-r heading (1- depth) row (1+ column)) 

(non-nil-cons (diag-up-link-ur 1 (1- depth) (1- row) (1+ column)) 

(non-nil-cons (diag-down-link-lr 3(1+ depth) (1+ row) (1+ column)) 
(non-nil-cons (diag-down-link-r heading (1+ depth) row (1+ column)) 
(non-nil-cons (diag-down-link-ur 1 (1+ depth) (1-row) (1 + column)) nil)))))))))) 

(defun 4-link (heading depth row column) 

(if (not (equal (state heading depth row column) ‘obstacle)) 

Gist (list heading depth row column) 2))) 

(defun diag-link-ul (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading depth row (1+ column)) ‘obstacle)) 

(not (equal (state heading depth (1+ row) column) ‘obstacle)))) 

(list Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-link-11 (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading depth (1- row) column) ‘obstacle)) 

(not (equal (state heading depth row (1+ column)) ‘obstacle)))) 

Gist Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-link-lr (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading depth (1- row) column) ‘obstacle)) 

(not (equal (state heading depth row (1- column)) ‘obstacle)))) 

Gist Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-link-ur (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading depth row (1- column)) ‘obstacle)) 

(not (equal (state heading depth (1+ row) column) ‘obstacle)))) 

Gist Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-up-link-ul (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading (1+ depth) row column) ‘obstacle)) 

(not (equal (state heading depth (1+ row) (1+ column)) ‘obstacle)))) 

Gist Gist heading depth row column) (* 2 (sqrt 2))))) 



43 



(defun diag-up-link-1 (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading (1+ depth) row column) ‘obstacle)) 
(not (equal (state heading depth row (1+ column)) ‘obstacle)))) 

Gist Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-up-link-11 (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading (1+ depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1- row) (1+ column)) ‘obstacle)))) 
Gist Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-up-link-d (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading (1+ depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1- row) column) ‘obstacle)))) 

Gist Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-up-link-lr (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading (1+ depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1- row) (1- column)) ‘obstacle)))) 
Gist Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-up-link-r (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading (1+ depth) row column) ‘obstacle)) 
(not (equal (state heading depth row (1- column)) ‘obstacle)))) 

Gist Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-up-link-ur (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading (1+ depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1+ row) (1- column)) ‘obstacle)))) 
Gist Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-up-link-u (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading (1+ depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1+ row) column) ‘obstacle)))) 

Gist Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-down-link-ul (heading depth row column) 
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(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading (1- depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1+ row) (1+ column)) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-down-link-1 (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading (1- depth) row column) ‘obstacle)) 
(not (equal (state heading depth row (1+ column)) ‘obstacle)))) 

(list (list heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-down-link-11 (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading (1- depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1- row) (1+ column)) ‘obstacle)))) 
Gist Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-down-link-d (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading (1- depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1- row) column) ‘obstacle)))) 

Gist Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-down-link-lr (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading (1- depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1- row) (1- column)) ‘obstacle)))) 
Gist Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-down-link-r (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading (1- depth) row column) ‘obstacle)) 
(not (equal (state heading depth row (1- column)) ‘obstacle)))) 

Gist Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-down-link-ur (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 

(or (not (equal (state heading (1- depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1+ row) (1- column)) ‘obstacle)))) 
Gist Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun diag-down-link-u (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
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(or (not (equal (state heading (1- depth) row column) ‘obstacle)) 

(not (equal (state heading depth (1+ row) column) ‘obstacle)))) 

Gist Gist heading depth row column) (* 2 (sqrt 2))))) 

(defun non-nil-cons (item list) 

(if (null item) list (cons item list))) 

(defun initialize-heading-connected-map (heading-size depth-size row-size column-size) 
(make-terrain heading-size depth-size row-size column-size) 

(dotimes (h (- heading-size 2)) 

(dotimes (k (- heading-size 2)) 

(dotimes (i (- row-size 2)) 

(dotimes (j (- column-size 2)) 

(set-tendril- length (1+ h) (1+ k) (1+ i) (1+ j) 0) 

(if (=(l+h) 1) 

(set-link-list (1+ h) (1+ k) (1+ i) (1+ j) 

Gegal-fwd-connected-link-list (1+ h) (1+ k) (1+ i) (1+ j)))) 

(if (= (1+ h) 2) 

(set-link-list (1+ h) (1+ k) (1+ i) (1+ j) 

Gegal-left-connected-link-list (l+h)(l+k)(l+i) (1+ j)))) 

(if (= (1+ h) 3) 

(set-link-list (1+ h) (1+ k) (1+ i) (1+ j) 

Gegal- back-connected-link-list (1+ h) (1+ k) (1+ i) (1+ j)))) 

(if (= (1+ h) 4) 

(set-link-list (1+ h) (1+k) (1+ i) (1+ j) 

Gegal-right-connected-link-list (1+ h) (1+ k) (1+ i) (1+ j))))))))) 

(defun update-root-node (heading depth row column new-tendril-length new-link-list) 
(set-tendril-length heading depth row column new-tendril-length) 

(set-link-list heading depth row column new-link-list)) 

(defun activate-end-node (root node residue) 

(if (equal node *goal*) (setf *goal-flag* t)) 

(set-state (first node) (second node) (third node) (fourth node) *cycle-number*) 
(set-parent (first node) (second node) (third node) (fourth node) root) 

(set-tendril-length (first node) (second node) (third node) (fourth node) residue) 

(setf *new-active-node-list* (cons node *new-active-node-list*))) 

(defun verify-parent (root node residue) 

(when (> residue (tendril-length (first node) (second node) (third node) (fourth node))) 
(set-parent (first node) (second node) (third node) (fourth node) root) 

(set-tendril-length (first node) (second node) (third node) (fourth node) residue))) 
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(defun test-link (root link tendril-length) 

(let ((residue (- tendril-length (second link))) 

(end-node-state (state (first (first link)) (second (first link)) (third (first link)) (fourth (first 
link))))) 

(cond ((and (null end-node-state) (>= residue 0)) 

(activate-end-node root (first link) residue) nil) 

((and (numberp end-node-state) (= *cycle-number* end-node-state) 

(>= residue 0)) 

(verify-parent root (first link) residue) nil) 

((null end-node-state) link)))) 

(defun grow-tendrils (root tendril-increment) 

(let* ((heading (first root)) (depth (second root)) (row (third root)) (column (fourth root)) 
(new-tendril-length (+ tendril-increment (tendril-length heading depth row column))) 
(new-link-list nil)) 

(dolist (link (link-list heading depth row column) 

(update-root-node heading depth row column new-tendril-length new-link-list)) 

(setf new-link-list (non-nil-cons (test-link root link new-tendril-length) 
new-link-list))))) 

(defun increment-wavefront (tendril-increment) ;retumed value not used 
(dolist (root *active-node-list* *new-active-node-list*) 

(setf *new-active-node-list* 

(non-nil-cons (test-root root tendril-increment) *new-active-node-list*)))) 

(defun test-root (root tendril-increment) ;retums root if any tendrils alive 
(if (grow-tendrils root tendril-increment) root)) 

(defun find-path (start goal tendril-increment) 

(initialize-heading-connected-map 6 7 7 7) 

(set-state (first start) (second start) (third start) (fourth start) 0) 

(setf *goal* goal *cycle-number* 0 *active-node-list* (list start) 

*goal-flag* nil) 

(loop (if (or (null *active-node-list*) (not (null *goal-flag*))) 

(return (if (not (null *goal-flag*)) (pprint (path-to-goal goal))))) 

(setf *new-active-node-list* nil) 

(setf *cycle-number* (1+ *cycle-number*)) 

(setf *active-node-list* (increment-wavefront tendril-increment)))) 

(defun path-to-goal (goal) 

Get ((parent (parent (first goal) (second goal) (third goal) (fourth goal)))) 

(if parent (cons goal (path-to-goal parent))))) 
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APPENDIX D (pan 1) 

Table 1: Data Dictionary for the Tendril Search 



PACKAGE 

PROCEDURE 

VARIABLE 


TYPE 


GLOBALS 

DATA_FILE 

PATHFILE 


FILE_TYPE 


LOC.ARRAY 


array ( 1 ..4) of INTTYPE 


LIST 


record {LOC : LOC.ARRAY 
INC : INT_TYPE 
NEXT : LIST_PTR) 


NODE 


record {STATE : INTTYPE 

PARENT : LOC.ARRAY 
TEND_LEN : INT.TYPE} 


NODE.ARRAY 


array (INT_TYPE range o, 
INT_TYPE range o, 

INT TYPE range o, 

INT TYPE range o) of NODE 


START_TIME 

END_TIME 


TIME 


TTIME 


DURATION 


MAX.ROW 
MAX_COL 
MAX_DEP 
MAX_HDG 
DIAG_COST := 99 
CARD_COST := 70 


INTTYPE 
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Table 1: Data Dictionary for the Tendril Search 



PACKAGE 

PROCEDURE 

VARIABLE 


TYPE 


WAVE 

NEW.WAVE 

NW_TAIL 

LAST_NEW_WAVE 

WAVE_HEAD 

WAVE_TAIL 

THE_PATH 

THE_PATH_CURRENT 

TRASH 


LIST.PTR := null 


START 

GOAL 


LOC_ARRAY 


GOAL.FOUND 


BOOLEAN := FALSE 


PATH 
GET DATA 

FILE_NAME 


STRING (L. 12) 


NAME.LEN 


INT_TYPE 


P PATH 
NEXT.LOC 


LOC_ARRAY 


F MOVES 
HEADING 


INTTYPE := ROOT.LOC (4) 


F PATH 
ROOT 


LIST.PTR := WAVE 


DO SEARCH 
N.ARRAY 


NODE_ARRAY (l..MAX_ROW, 

1.. MAX_COL, 

1.. MAX_DEP, 

1.. MAX_HDG) 
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Table 1: Data Dictionary for the Tendril Search 



PACKAGE 

PROCEDURE 

VARIABLE 


TYPE 


THE MOVE 
CK STATE 






NEW_ELE 


LIST_PTR 




CHECK MOVE 






NEW_LOC 


LOC.ARRAY 


:= ROOT.LOC 
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DATA FLOW DIAGRAM for the TENDRIL SEARCH (pan 2) 
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TENDRIL SEARCH CODE (part 3) 



— NAME : J. Bonsignore, Jr. 

— DATE : 22 Jan, 1991 

— REVISED : 

— TITLE : TENDRIL. ADA 

— DESCRIPTION : Main procedure for the Tendril search 

— CALLS : GET_DATA and DO_SEARCH in the PATH package 

— NOTES : 



with TEXT_IO, GLOBALS, PATH; 
use TEXT_IO, GLOBALS, PATH; 

procedure TENDRIL is 

begin 

GET_DATA; 

DO_SEARCH; 
end TENDRIL; 
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— NAME : J. Bonsignore, Jr. 

— DATE : 22 Jan, 1991 

— REVISED : 

— TITLE : GLOBALS . ADS 

— DESCRIPTION : Global variables for the searches 

— CALLS : 

--NOTES : 



with TEXT_IO, CALENDAR; 
use TEXT_IO, CALENDAR; 

package GLOBALS is 

subtype INT_TYPE is INTEGER; 

package INT_IO is new INTEGER_IO ( INT_TYPE) ; 
package FLOAT 10 is new FL0AT_I0 (FLOAT) ; 
use INT_IO, FLOATIO; 

type LOC_ARRAY is array (1..4) of INT_TYPE; 
type LIST; 

type LIST_PTR is access LIST; 
type LIST is 
record 

LOC : LOC_ARRAY : = (others => 0); 

INC : INT_TYPE := 0; 

NEXT : LIST_PTR; 
end record; 

type NODE; 

type NODE_PTR is access NODE; 
type NODE is 
record 

STATE : INT_TYPE := 0; 

PARENT : LOC_ARRAY := (others => 0) ; 

TEND_LEN : INT_TYPE := 0; 
end record; 

type NODE_ARRAY is array (INT_TYPE range <>, INT_TYPE range 

<>, INT_TYPE range <>, INT_TYPE 
range <>) of NODE; 
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DATA_F I LE 


: 


FILE_TYPE; 






PATH_FILE 


• 


FILE_TYPE; 






START_TIME 


; 


TIME; 






END_TIME 




TIME; 






T_TIME 


• 


DURATION; 






MAX_ROW 




INT_TYPE; 






MAX_COL 




INT_TYPE; 






MAX_DEP 




INT_TYPE; 






MAX_HDG 




INT_TYPE; 






DIAG_COST 


• 

• 


INT_TYPE := 


99; 




CARD_COST 


• 


INT_TYPE ;= 


70; 




WAVE 




: LIST_PTR 


l = 


null; 


NEW_WAVE 




: LIST_PTR 


• 

• 


null; 


NW TAIL 




: LIST PTR 


• 


null; 


LAS T_NE W_WAVE : LIST_PTR 


• = 
• 


null; 


WAVE_HEAD 




: LI ST_PTR 


:= null 


WAVE_TAIL 




; LIST_PTR 


:= null 


THE PATH 




: LIST PTR 


:= null 


THE_PATH_CURRENT : LIST_PTR 


:= null 


TRASH : LIST_ 


PTR := null; 






START 


• 

• 


LOC_ARRAY; 






GOAL 


• 

• 


LOC_ARRAY; 






GOAL FOUND 


• 

• 


BOOLEAN := FALSE; 



end GLOBALS; 
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— NAME 
— DATE 
--REVISED 
— TITLE 
— DESCRIPTION 



J. Bonsignore, Jr. 
22 Jan, 1991 

PATH. ADS 



—CALLS 
— NOTES 



with TEXT_IO, GLOBALS, THE_MOVE, 

UNCHECKED_DEALLOCAT ION , CALENDAR; 

use TEXT_IO, GLOBALS, THE_MOVE, CALENDAR; 

package PATH is 

procedure DO_SEARCH; 

procedure GET_DATA; 

procedure READ_TER (N_ARRAY : in out NODE_ARRAY) ; 
procedure P_PATH (N_ARRAY : in out NODE_ARRAY) ; 
end PATH; 



— NAME 
— DATE 
— REVISED 
— TITLE 
— DESCRIPTION 



J. Bonsignore, Jr. 
22 Jan, 1991 

PATH . ADB 



— CALLS 
— NOTES 



package body PATH is 

procedure GET_DATA is 

FILE NAME : STRING (1..12); 
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NAME_LEN : INT_TYPE; 
begin 

put ("Enter the name of data file: "); 

get_line ( F I LE_NAME , NAME_LEN) ; 

F I LE_NAME ( (NAME_LEN + 1)..12) := (others => ' '); 

F I LE_NAME (9.. 12) := ".DAT"; 

OPEN (DATA_FILE, MODE => IN_FILE, NAME => F I LE_NAME ) 
I NT_I 0 . ge t ( DATA_F I LE , MAX_ROW ) ; 

INT_IO . get (DATA_FILE, MAX_COL) ; 

INT_IO . get (DATA_FILE, MAX_DEP) ; 

INT_IO.get (DATA_FILE, MAX_HDG) ; 

NEW_LINE; 

put ("Enter the starting row: "); 

INT_IO. get (START (1) ) ; 

NEW_LINE; 

put ("Enter the starting col: "); 

INT_IO. get (START (2) ) ; 

NEW_LINE; 

put ("Enter the starting dep: "); 

INT_IO. get (START (3)); 

NEW_LINE; 

put ("Enter the starting hdg: "); 

INT_IO.get (START (4 ) ) ; 

NEW_LINE; 

put ("Enter the goal row: "); 

INT_IO.get (GOAL (1) ) ; 

NEW_LINE; 

put ("Enter the goal col: ") ; 

INT_IO.get (GOAL (2) ) ; 

NEW_LINE; 

put ("Enter the goal dep: "); 

INT_IO . get (GOAL (3) ) ; 

NEW_LINE; 

put ("Enter the goal hdg: "); 

INT_IO.get (GOAL (4 ) ) ; 

WAVE := new LIST; 

WAVE . LOC := START; 

WAVE. INC := 0; 
end GET_DATA; 

procedure READ_TER (N_ARRAY : in out NODE_ARRAY) is 
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begin 



for ROW in l..MAX_ROW loop 
for COL in l..MAX_COL loop 

for DEP in l..MAX_DEP loop 
for HDG in l..MAX_HDG loop 
INT_IO.get (DATA_FILE, N_ARRAY (ROW, COL, 
DEP, HDG). STATE); 

N_ARRAY (ROW, COL, DEP, HDG) .TEND_LEN := 0; 
N_ARRAY (ROW, COL, DEP, HDG) .PARENT := 

( 0 , 0 , 0 , 0 ); 

end loop; 
end loop; 
end loop; 
end loop; 

close (DATA_FILE) ; 
end READ_TER; 

procedure P_PATH (N_ARRAY : in out NODE_ARRAY) is 

NEXT_LOC : LOC_ARRAY; 

PATH FILE : FILE TYPE; 



begin 



if GOAL_FOUND then 
CREATE (PATH_FILE, 
put ('('); 

INT_IO . put 
INT_IO . put 
INT_IO . put 
INT_IO . put 
put O'); 

INT_IO . put 
INT_IO . put 
INT_IO . put 
INT_IO . put 
new_line; 

new_line (PATH_FILE) ; 
NEXT_LOC : = N_ARRAY (GOAL ( 1 ) , 

GOAL ( 4 ) ) 

while NEXT_LOC /= START loop 
put CO; 



NAME => "path. file") 



(GOAL ( 1 ) ) ; 
(GOAL (2) ) ; 
(GOAL (3) ) ; 
(GOAL (4) ) ; 

(PATH_FILE, 
(PATH_FILE, 
(PATH_FILE, 
(PATH FILE, 



GOAL ( 1 ) ) ; 
GOAL (2) ) ; 
GOAL (3) ) ; 
GOAL (4) ) ; 



GOAL (2) , 
PARENT; 



GOAL ( 3 ) 



INT_IO . put (NEXT_LOC(l) ) ; 
INT_IO . put (NEXT LOC ( 2 ) ) ; 



57 



INT_IO . put (NEXT_LOC (3) ) ; 
INT_IO . put (NEXT_LOC (4 ) ) ; 
put (')'); 



INT_IO .put (PATH_FILE, NEXT_LOC ( 1 ) ) ; 

INT_IO .put ( P ATH_F I LE , NEXT_LOC ( 2 ) ) ; 

INT_IO . put (PATH_FILE, NEXT_LOC ( 3 ) ) ; 
INT_IO.put (PATH_FILE, NEXT_LOC ( 4 ) ) ; 
NEXT_LOC := N_ARRAY (NEXT_LOC (1) , NEXT_L0C(2), 
NEXT LOC (3 ) , NEXT LOC ( 4 )). PARENT 



NEW LINE; 



new_line (PATH_FILE) ; 
end loop; 
put ( ' ( ' ) ; 



INT_IO.put 
INT_IO .put 
INT_IO . put 
INT_IO .put 
put (’)'); 



(START (1) ) ; 
(START (2) ) ; 
(START (3) ) ; 
(START (4) ) ; 



INT_IO.put 
INT_IO .put 
INT_IO.put 
INT_IO .put 
new line; 



(PATH_FILE, 
(PATH_FILE, 
(PATH_FILE, 
(PATH FILE, 



START (1) ) ; 
START (2) ) ; 
START (3) ) ; 
START (4) ) ; 



new_line (PATH_FILE) ; 

INT_IO .put (N_ARRAY (GOAL(l), GOAL (2), GOAL (3), 

GOAL (4) ) .TEND LEN) ; 



new line; 



CLOSE (PATH FILE) ; 



else 



put ("PATH NOT FOUND"); 
new_line; 
end if; 
end P PATH; 



procedure F_MOVES (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

HEADING : INT TYPE := ROOT. LOC (4); 



begin 

case HEADING is 
when 1 => 

CHECK UP NW (N ARRAY, ROOT) ; 
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CHECK_UP_N ( N_ARRA Y , ROOT) ; 
CHECK_UP_NE (N_ARRAY, ROOT) ; 
CHECK_NW ( N_ARRA Y , ROOT) ; 
CHECK_N ( N_ARRA Y , ROOT) ; 
CHECK_NE (N_ARRAY, ROOT) ; 
CHECK_DOWN_NW (N_ARRAY, ROOT) 
CHECK_DOWN_N (N_ARRAY, ROOT) ; 
CHECK_DOWN_NE ( N_ ARRAY , ROOT) 

when 2 => 

CHECK_UP_NE ( N_ARRA Y , ROOT) ; 
CHECK_UP_E ( N_ARRA Y , ROOT) ; 
CHECK_UP_SE (N_ARRAY, ROOT) ; 
CHECK_NE (N_ARRAY, ROOT) ; 
CHECK_E (N_ARRAY, ROOT) ; 
CHECK_SE (N_ARRAY, ROOT) / 
CHECK_DOWN_NE (N_ARRAY, ROOT) 
CHECK_DOWN_E ( N_ARRA Y , ROOT) ; 
CHECK_DOWN_SE (N_ARRAY, ROOT) 

when 3 => 

CHECK_UP_SE (N_ARRAY, ROOT) ; 
CHECK_UP_S (N_ARRAY, ROOT) ; 
CHECK_UP_SW (N_iVRRAY, ROOT) ; 
CHECK_SE (N_ARRAY, ROOT) ; 
CHECK_S (N_ARRAY, ROOT) ; 
CHECK_SW (N_ARRAY, ROOT) ; 
CHECK_DOWN_SE (N_ARRAY, ROOT) 
CHECK_DOWN_S (N_ARRAY, ROOT) ; 
CHECK_DOWN_SW (N_ARRAY, ROOT) 

when 4 => 

CHECK_UP_SW (N_ARRAY, ROOT) ; 
CHECK_UP_W ( N_ARRA Y , ROOT) ; 
CHECK_UP_NW (N_ARRAY, ROOT) ; 
CHECK_SW (N_ARRAY, ROOT) ; 
CHECK_W ( N_ARRA Y , ROOT) ; 
CHECK_NW (N_ARRAY, ROOT) ; 
CHECK_DOWN_SW ( N_ARRA Y , ROOT) 
CHECK_DOWN_W (N_ARRAY , ROOT) ; 
CHECK_DOWN_NW (N_ARRAY, ROOT) 

when others => 
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null; 



end case; 
end F_MOVES; 

procedure FREE is new UNCHECKED_DEALLOCATION (LIST, 
LIST PTR) ; 



procedure F_PATH (N_ARRAY : in out NODE_ARRAY) is 
ROOT : LIST PTR := WAVE; 



begin 

while ROOT /= null loop 
F_MOVES (N_ARRAY, ROOT) ; 

ROOT := WAVE. NEXT; 

FREE (WAVE) ; 

WAVE := ROOT; 
end loop; 

if GOAL_FOUND then 
return; 
end if; 

WAVE := NEW_WAVE; 

NEW_WAVE := null; 

LAS T_NE W_WAVE := null; 
end F_P ATH ; 

procedure DO_SEARCH is 

N_ARRAY ; NODE_ARRAY (l..MAX_ROW, l..MAX_COL, 

1 . . MAX DEP, 1 . . MAX HDG) 



begin 

START_TIME := CLOCK; 

READ_TER (N_ARRAY) ; 
while WAVE /= null loop 
F_PATH (N_ARRAY) ; 
exit when GOAL_FOUND; 
end loop; 

P_PATH (N_ARRAY) ; 

END_TIME := CLOCK; 

T_TIME ;= END TIME - START TIME; 
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NEW_LINE; 

FLOAT 10 . put (FLOAT (T_TIME) ) ; 
put (" seconds of cpu time.") 
end DO_SEARCH; 

end PATH; 
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— NAME 
— DATE 
— REVISED 
— TITLE 


: J. Bonsignore, Jr. 

: 22 Jan, 1991 

: THE MOVE. ADS 



— DESCRIPTION : Contains the procedures for checking and 



—CALLS 
— NOTES 


: processing individual 

: nodes sent from F_MOVES. 



with TEXT_IO, GLOBALS; 
use TEXT_IO, GLOBALS; 

package THE_MOVE is 

procedure NNC (ELEMENT ; in LIST_PTR; 

HEAD : in out LIST PTR; 





TAIL : in out LIST_PTR) ; 


procedure 


GROW_TEND (ELE : in out LIST_PTR; 

N_ARRAY : in out NOD E_ARRA Y ; 
ROOT : in out LIST_PTR) ; 


procedure 


CK_STATE (NEW_LOC : in out LOC_ARRAY ; 

N_ARRAY : in out NODE_ARRAY; 

NEW_INC : in out INTJTYPE; 

ROOT : in out LIST_PTR) ; 


procedure 


CHECK_N (N_ARRAY : in out NODE_ARRAY ; 
ROOT ; in out LIST_PTR) ; 


procedure 


CHECK_UP_N (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 


procedure 


CHECK_DOWN_N (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) ; 


procedure 


CHECK_NE (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) ; 


procedure 


CHECK_UP_NE (N_ARRAY : in out NODE_ARRAY; 

ROOT ; in out LIST PTR) ; 
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procedure CHECK_DOWN_NE (N_ARRAY : in out NODE_ARRAY 

ROOT : in out LIST_PTR) ; 

procedure CHECK_E (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_UP_E (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_DOWN_E (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_SE (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_UP_SE (N_ARRAY : in out NODE_ARRA Y ; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_DOWN_SE (N_ARRAY : in out NODE_ARRAY 

ROOT : in out LIST_PTR) ; 

procedure CHECK_S (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_UP_S (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_DOWN_S (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_SW (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_UP_SW (N_ARRAY : in out N ODE_ARRAY ; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_DOWN_SW (N_ARRAY : in out NODE_ARRAY 

ROOT : in out LIST_PTR) ; 

procedure CHECK_W (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST PTR) ; 
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procedure CHECK_UP_W (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_DOWN_W (N_ARRAY : in out NOD E_ARRA Y ; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_NW (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_UP_NW (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_DOWN_NW (N_ARRAY : in out NOD E_ARRA Y ; 

ROOT : in out LIST PTR) ; 



end THE MOVE; 



—NAME 
— DATE 
— REVISED 
—TITLE 
—DESCRIPTION 



J. Bonsignore, Jr. 

22 Jan, 1991 

THE_MOVE . ADB 

The package body for THE_MOVE 



with TEXT_IO, GLOBALS; 
use TEXT_IO, GLOBALS; 

package body THE_MOVE is 

procedure NNC (ELEMENT : in LIST_PTR; 

HEAD : in out LIST_PTR; 

TAIL : in out LIST_PTR) is 

Creates and performs list maintanence. 
begin 

if HEAD = null then 

HEAD := ELEMENT; 

TAIL := ELEMENT; 

else 

TAIL. NEXT := ELEMENT; 

TAIL := TAIL. NEXT; 

end if; 
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end NNC; 



procedure GROW_TEND (ELE : in out LIST_PTR; 

N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

Determines if nodes have been previously processed and if 
necessary reassignes. 

procedure ASSIGN (N_ARRAY : in out NODE_ARRAY; 

ELE : in out LIST_PTR; 

ROOT : in out LIST_PTR) is 

Once a node is determined to be a legal move its 
attributes 

are assigned, and the GOAL is checked for completion. 



begin 

N_ARRAY (ELE.LOC (1) ,ELE.LOC (2) ,ELE.LOC (3) , 
ELE. LOC (4) ) .PARENT := ROOT.LOC; 
N_ARRAY (ELE.LOC (1) ,ELE.LOC (2) , ELE.LOC (3) , 
ELE.LOC (4) ) .TEND_LEN := ELE . INC + 
N_ARRAY (ROOT.LOC (1) , ROOT.LOC (2) , ROOT. LOC (3) , 
ROOT . LOC ( 4 ) ) . TEND_LEN ; 
if ELE.LOC = GOAL then 

GOAL_FOUND : = TRUE; 

end if; 

NNC (ELE, NEW_WAVE , NW_TAIL) ; 
end ASSIGN; 



begin 

if N_ARRAY (ELE.LOC (1) ,ELE.LOC(2) ,ELE.LOC(3) , 
ELE.LOC (4) ) .TEND_LEN = 0 then 
ASSIGN (N_ARRAY, ELE, ROOT) ; 
elsif N_ARRAY (ELE.LOC (1) ,ELE.LOC(2) ,ELE.LOC(3) , 
ELE . LOC ( 4 ) ) . TEND_LEN > 

(N_ARRAY (ROOT.LOC (1) ,ROOT.LOC(2) ,ROOT.LOC(3) , 
ROOT . LOC ( 4 ) ) . TEND_LEN + ELE. INC) then 
ASSIGN (N_ARRAY, ELE, ROOT) ; 
end if; 
end GROW_TEND; 

procedure CK_STATE (NEW LOC : in out LOC ARRAY; 
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N_ARRAY : in out NODE_ARRAY ; 

NEW_INC : in out INTJTYPE; 

ROOT : in out LIST_PTR) is 

Checks if the node is an obstacle. If not it calls the 
GROW_TEND procedure. 

NEW ELE : LIST PTR; 



begin 

i f N_ARRAY (NEW_LOC ( 1 ) , NEW_LOC ( 2 ) , NEW_LOC ( 3 ) , 
NEW_L0C(4) ) .STATE = 0 then 
NEW_ELE := new LIST; 

NEW_ELE . LOC := NEW_LOC; 

NEW_ELE . INC := NEW_INC; 

GROW_TEND (NEW_ELE, N_ARRAY, ROOT) ; 
end if; 
end CK_STATE; 

The remaining procedures are for individual "moves." The 
coordinates are calculated and a cost is assigned to the 
move. Each calls CK_STATE. 

procedure CHECK_N (N_ARRAY ; in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

NEW_LOC : LOC_ARRAY := ROOT. LOC; 

begin 

IF NEW_LOC ( 1 ) > 1 then 

NEW_LOC ( 1 ) := NEW_LOC ( 1 ) - 1; 

CK_STATE (NEW_LOC, N_ARRAY, CARD_COST, ROOT) ; 
end if; 
end CHECK_N; 

procedure CHECK_UP_N (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY ;= ROOT. LOC; 



begin 

IF NEW_LOC ( 1 ) > 1 and NEW_LOC(3) > 1 then 
NEW_LOC ( 1 ) ;= NEW LOC(l) - 1; 
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NEW_LOC ( 3 ) := NEW_L0C(3) - 1; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_UP_N; 

procedure CHECK_DOWN_N (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW_LOC ( 1 ) > 1 and NEW_LOC(3) < MAX_DEP then 
NEW_LOC ( 1 ) := NEW_LOC(l) - 1; 

NEW_LOC ( 3 ) := NEW_LOC(3) + 1; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_DOWN_N; 

procedure CHECK_NE (N_ARRAY : in out NOD E_ARRA Y ; 

ROOT : in out LIST_PTR) is 

NEW_LOC : LOC_ARRAY := ROOT.LOC; 

begin 

if NEW_LOC ( 1 ) > 1 and NEW_L0C(2) < MAX_COL then 
NEW_LOC ( 1 ) := NEW_LOC ( 1 ) - 1; 

NEW_LOC ( 2 ) := NEW_LOC ( 2 ) + 1; 

if ROOT.LOC (4) = 1 then 
NEW_LOC ( 4 ) := 2; 

else 

NEW_LOC ( 4 ) := 1; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 
end CHECK_NE ; 

procedure CHECK_UP_NE (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW LOC ( 1 ) > 1 and NEW LOC (2) < MAX COL and 
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NEW_L0C(3) > 1 then 

NEW_L0C(1) := NEW__L0C(1) - 1; 

NEW_LOC ( 2 ) := NEW_L0C(2) + 1; 

NEW_L0C(3) := NEW_LOC ( 3 ) - 1; 
if ROOT . LOC (4 ) = 1 then 
NEW_LOC ( 4 ) := 2; 

else 

NEW_LOC ( 4 ) := 1; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_UP_NE ; 

procedure CHECK_DOWN_NE (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT. LOC; 



begin 

IF NEW_LOC(l) > 1 and NEW_LOC(2) < MAX_COL and 
NEW_LOC ( 3 ) < MAX_DEP then 

NEW_LOC ( 1 ) := NEW_LOC(l) - 1; 

NEW_L0C(2) := NEW_LOC (2) + 1; 

NEW_LOC ( 3 ) := NEW_LOC ( 3 ) + 1; 

if ROOT. LOC (4) = 1 then 
NEW_LOC ( 4 ) := 2; 

else 

NEW_LOC ( 4 ) := 1; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_DOWN_NE; 

procedure CHECK_E (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT. LOC; 



begin 

IF NEW_LOC ( 2 ) < MAX_COL then 
NEW_LOC ( 2 ) := NEW_LOC (2) + 1; 

CK_STATE (NEW_LOC, N_ARRAY, CARD_COST, ROOT) ; 
end if; 
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end CHECK E; 



procedure CHECK_UP_E (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW_LOC ( 2 ) < MAX_COL and NEW_LOC(3) > 1 then 
NEW_LOC (2 ) := NEW_LOC(2) + 1; 

NEW_LOC ( 3 ) := NEW_LOC ( 3 ) - 1; 

CK_STATE (NEW_LOC, N_ARRAY , DIAG_COST # ROOT) ; 
end if; 

end CHECK UP E; 



procedure CHECK_DOWN_E (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW_LOC ( 2 ) < MAX_COL and NEW_LOC(3) < MAX_DEP 
then 

NEW_LOC ( 2 ) := NEW_LOC ( 2 ) + 1; 

NEW_LOC ( 3 ) := NEW_LOC(3) + 1; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_DOWN_E; 

procedure CHECK_W (N_ARRAY : in out NOD E_ARRA Y ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW_LOC ( 2 ) > 1 then 

NEW_LOC ( 2 ) := NEW_LOC (2 ) - 1; 

CK_STATE (NEW_LOC, N_ARRAY, CARD_COST, ROOT); 
end if; 
end CHECK_W; 

procedure CHECK_UP_W (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST PTR) is 
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NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW_LOC ( 2 ) > 1 and NEW_LOC(3) > 1 then 
NEW_LOC (2) := NEW_LOC ( 2 ) - 1; 

NEW_LOC ( 3 ) := NEW_LOC(3) - 1; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_UP_W ; 

procedure CHECK_DOWN_W (N_ARRAY ; in out NOD E_ARRA Y ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW_LOC ( 2 ) > 1 and NEW_LOC(3) < MAX_DEP then 
NEW_LOC ( 2 ) := NEW_LOC(2) - 1; 

NEW_LOC ( 3 ) := NEW_LOC(3) + 1; 

CK_S TATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK JDOWN_W; 

procedure CHECK_S (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY ;= ROOT.LOC; 



begin 

IF NEW_LOC ( 1 ) < MAX_ROW then 
NEW_LOC ( 1 ) := NEW_LOC ( 1 ) + 1; 

CK_STATE (NEW_LOC, N_ARRAY, CARD_COST, ROOT) ; 
end if; 
end CHECK_S; 

procedure CHECK_UP_S (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW LOC ( 1 ) < MAX ROW and NEW LOC (3) > 1 then 



70 



NEW_L0C(1) := NEW_L0C(1) + 1; 

NEW_LOC ( 3 ) := NEW_L0C(3) - 1; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_UP_S ; 

procedure CHECK_DOWN_S (N_ARRAY : in out NODE_ARRAY; 

ROOT ; in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW__LOC ( 1 ) < MAX_ROW and NEW_LOC(3) < MAX_DEP 
then 

NEW_L0C(1) := NEW_LOC ( 1 ) + 1; 

NEW_LOC ( 3 ) := NEW_LOC(3) + 1; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_DOWN_S; 

procedure CHECK_SE (N_ARRAY : in out NOD E_ARRA Y ; 

ROOT : in out LIST_PTR) is 

NEW_LOC : LOC_ARRAY := ROOT.LOC; 

begin 

IF NEW_LOC ( 1 ) < MAX_ROW and NEW_LOC(2) < MAX_COL 
then 

NEW_LOC ( 1 ) := NEW_LOC(l) + 1; 

NEW_LOC ( 2 ) := NEW_LOC(2) + 1; 

if ROOT.LOC (4) = 2 then 
NEW_LOC ( 4 ) := 3; 

else 

NEW_LOC ( 4 ) := 2; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 
end CHECK_SE; 

procedure CHECK_UP_SE (N_ARRAY ; in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 
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begin 



IF NEW_L0C(1) < MAX_ROW and NEW_L0C(2) < MAX_COL 
and NEW_LOC ( 3 ) > 1 then 

NEW_LOC ( 1 ) := NEW_LOC ( 1 ) + 1; 

NEW_LOC ( 2 ) := NEW_LOC ( 2 ) + 1; 

NEW_LOC ( 3 ) := NEW_L0C(3) - 1; 

if ROOT . LOC (4 ) = 2 then 
NEW_LOC ( 4 ) := 3; 

else 

NEW_LOC ( 4 ) := 2; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_UP_SE ; 

procedure CHECK_DOWN_SE (N_ARRAY ; in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT. LOC; 



begin 

IF NEW_LOC ( 1 ) < MAX_ROW and NEW__LOC(2) < MAX_COL 
and NEW_L0C(3) < MAX_DEP then 
NEW_LOC ( 1 ) := NEW_LOC ( 1 ) + 1; 

NEW_LOC(2) := NEW_LOC ( 2 ) + 1; 

NEW_LOC ( 3 ) := NEW_L0C(3) + 1; 

if ROOT. LOC (4) = 2 then 
NEW_LOC ( 4 ) := 3; 

else 

NEW_LOC ( 4 ) := 2; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_DOWN_SE; 

procedure CHECK_SW (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT. LOC; 



begin 

IF NEW LOC (1 ) < MAX ROW and NEW LOC (2) > 1 then 



72 



NEW_LOC ( 1 ) := NEW_L0C(1) + 1; 

NEW_LOC ( 2 ) : = NEW_LOC ( 2 ) - 1 ; 

if ROOT . LOC (4 ) = 3 then 
NEW_LOC ( 4 ) : = 4 ; 

else 

NEW_LOC ( 4 ) := 3; 

end if; 

CK_S TATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 
end CHECK_SW; 

procedure CHECK_UP_SW (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT. LOC; 



begin 

IF NEW_LOC ( 1 ) < MAX_ROW and NEW_LOC(2) > 1 and 
NEW_LOC ( 3 ) > 1 then 

NEW_LOC ( 1 ) : = NEW_LOC ( 1 ) + 1 ; 

NEW_LOC ( 2 ) := NEW_LOC ( 2 ) - 1; 

NEW_LOC ( 3 ) := NEW_LOC ( 3 ) - 1; 

if ROOT. LOC (4) = 3 then 
NEW_LOC(4) := 4; 

else 

NEW_LOC ( 4 ) := 3; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_UP_SW; 

procedure CHECK_DOWN_SW (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT. LOC; 



begin 

IF NEW_LOC ( 1 ) < MAX_ROW and NEW_LOC(2) > 1 and 
NEW_LOC ( 3 ) < MAX_DEP then 

NEW_LOC ( 1 ) := NEW_LOC ( 1 ) + 1; 

NEW_LOC ( 2 ) := NEW_LOC (2 ) - 1; 

NEW_LOC ( 3 ) := NEW_LOC(3) + 1; 

if ROOT. LOC (4) = 3 then 
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NEW_LOC ( 4 ) := 4 ; 

else 

NEW_LOC ( 4 ) := 3; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_DOWN_SW; 

procedure CHECK_NW (N_ARRAY ; in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

NEW_LOC : LOC_ARRAY ;= ROOT.LOC; 

begin 

IF NEW_LOC ( 1 ) > 1 and NEW_LOC(2) > 1 then 
NEW_LOC ( 1 ) := NEW_L0C(1) - 1; 

NEW_L0C(2) := NEW_L0C(2) - 1; 
if ROOT.LOC (4) = 1 then 
NEW_LOC ( 4 ) := 4; 

else 

NEW_LOC ( 4 ) := 1; 

end if; 

CK_S TATE (NEW__LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 
end CHECK_NW; 

procedure CHECK_UP_NW (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

NEW_LOC : LOC_ARRAY ;= ROOT.LOC; 

begin 

IF NEW_L0C(1) > 1 and NEW_LOC(2) > 1 and NEW_LOC(3) 
> 1 then 

NEW_LOC ( 1 ) := NEW_L0C(1) - 1; 

NEW_LOC(2) := NEW_L0C(2) - 1; 

NEW_LOC(3) ;= NEW_L0C(3) - 1; 

if ROOT.LOC (4) = 1 then 
NEW_LOC ( 4 ) ;= 4; 

else 

NEW_LOC ( 4 ) : = 1 ; 

end if; 

CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT) ; 
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end if; 

end CHECK_UP_NW; 

procedure CHECK_DOWN_NW (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW_LOC(l) > 1 and NEW_LOC(2) > 1 and NEW_LOC(3) 

< 

MAX_DEP then 

NEW_LOC ( 1 ) := NEW_LOC ( 1 ) - 1; 

NEW_LOC ( 2 ) := NEW_LOC(2) - 1; 

NEW_LOC(3) := NEW_LOC ( 3 ) + 1; 
if ROOT.LOC (4) = 1 then 
NEW_LOC(4) := 4; 

else 

NEW_LOC ( 4 ) : = 1; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHE CK_D 0 WN_NW ; 
end THE MOVE; 
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APPENDIX E (pan 1) 



Table 1: Data Dictionary for the TENDRILWP Search 



PACKAGE 

PROCEDURE 

VARIABLE 


TYPE 


PATHWP 
GET DATA 

FILE.NAME 


STRING (1.. 12) 


NAME_LEN 


INTTYPE 


CONT 


CHARACTER := ‘Y’ 


EJPATH 

NEXT_LOC 


LOC_ ARRAY 


F MOVES 
HEADING 


INTTYPE := ROOT.LOC (4) 


F PATH 
ROOT 


LIST.PTR := WAVE 


DO SEARCH 
N.ARRAY 


NODE_ARRAY (l..MAX_ROW, 

1.. MAX_COL,‘ 

1.. MAX_DEP, 

1.. MAX_HDG) 
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DATA FLOW DIAGRAM for the TENDRILWP SEARCH (pan 2) 
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TENDRIL WP SEARCH CODE (part 3) 



—NAME 
—DATE 
— REVISED 
— TITLE 
— DESCRIPTION 
waypoints . 
—CALLS 
— NOTES 



J. Bonsignore, Jr. 

22 Jan, 1991 

TENDRILWP . ADA 

Main procedure for the Tendril search with 
GET_DATA, and DO_SEARCH in the PATHWP package 



with TEXT_IO, GLOBALS, PATHWP; 
use TEXT_IO, GLOBALS, PATHWP; 

procedure TENDRILWP is 

begin 

GET_DATA; 

DO_SEARCH; 
end TENDRILWP; 
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— NAME : J. Bonsignore, Jr. 

— DATE : 22 Jan, 1991 

— REVISED : 

— TITLE : PATHWP . ADS 

— DESCRIPTION : Contains the major procedures for the Tendril 

with waypoint 

: search 

— CALLS : 

— NOTES : 



with TEXT_IO, GLOBALS, THE_MOVE, UNCHECKED_DEALLOCAT I ON ; 
use TEXT_IO, GLOBALS, THE_MOVE ; 

package PATHWP is 

procedure DO_SEARCH; 

procedure GET_DATA; 

procedure READ_TER (N_ARRAY : in out NODE_ARRAY) ; 
procedure P_PATH (N_ARRAY : in out NODE_ARRAY) ; 
end PATHWP; 



—NAME 
— DATE 
—REVISED 
— TITLE 
— DESCRIPTION 
— NOTES 



J. Bonsignore, Jr. 

22 Jan, 1991 

PATHWP . ADB 

Package body for PATHWP package 
Differences from PATH package: GET_DATA 

makes a 

list of waypoints, P_PATH creates a list of 
records in each path segment and writes to 
file only (no screen output), RESET_ALL 
resets global variables to initial settings 
after each path segment is completed. 



package body PATHWP is 
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procedure GET_DATA is 

Opens the terrain data file, reads in the array dimensions 
and takes the starting and goal coordinates as input. 

F I LE_NAME : STRING (1..12); 

NAME_LEN : INT_TYPE; 

CONT : CHARACTER := »Y’; 

begin 

put ("Enter the name of data file: "); 

get_line (FILE_NAME, NAME_LEN) ; 

FILE_NAME ( (NAME_LEN + 1)..12) := (others => * '); 

F I LE_NAME (9.. 12) := ".DAT"; 

OPEN (DATA_FILE, MODE => IN_FILE, NAME => F I LE_NAME ) ; 
I NT_I 0 . ge t ( DATA_F I LE , MAX_ROW ) ; 

INT_IO. get (DATA_FILE, MAX_COL) ; 

INT_IO.get (DATA_FILE, MAX_DEP) ; 

INT_IO.get (DATA_FILE, MAX_HDG) ; 

NEW_LINE; 

WAVE_HEAD := new LIST; 

WAVE_TAIL := WAVE_HEAD; 
while CONT = 'y' or CONT = 'Y* loop 
put ("Enter the position row: "); 

INT_I 0 . get (WAVE_TAIL . LOC ( 1 ) ) ; 

NEW_LINE; 

put ("Enter the position col: "); 

INT_IO . get (WAVE_TAIL . LOC (2) ) ; 

NEW_LINE; 

put ("Enter the position dep: "); 

INT_IO . get ( WAVE_TAI L . LOC ( 3 ) ) ; 

NEW_LINE; 

put ("Enter the position hdg: "); 

INT_IO . get (WAVE_TAIL . LOC ( 4 ) ) ; 

NEW_LINE; 

put ("Enter another position?"); 
get (CONT) ; 

if CONT = *y' or CONT = 'Y' then 
WAVE_TAI L . NEXT := new LIST; 

WAVE_TAIL := WAVE_TAIL . NEXT; 
end if; 
end loop; 
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end GET DATA; 



procedure READ_TER (N_ARRAY : in out NODE_ARRAY) is 

— Reads the terrain data from the data file and initializes 

— the N_ARRAY . 

begin 

for ROW in l..MAX_ROW loop 
for COL in l..MAX_COL loop 

for DEP in l..MAX_DEP loop 
for HDG in l..MAX_HDG loop 
INT_IO.get ( DATA_F I LE , N_ARRAY (ROW, COL, DEP, 

HDG) .STATE) ; 

N_ARRAY (ROW, COL, DEP, HDG) .TEND_LEN := 0 
N_ARRAY (ROW, COL, DEP, HDG) .PARENT ;= 

( 0 , 0 , 0 , 0 ) ; 

end loop; 
end loop; 
end loop; 
end loop; 

Close (DATA_FILE) ; 
end READ_TER; 

procedure P_PATH (N_ARRAY : in out NODE_ARRAY) is 
Creates a list, THE_PATH and writes it to a file. 

NEXT LOC : LOC ARRAY; 



begin 

if GOAL_FOUND and THE_PATH = null then 
THE_PATH := new LIST; 

THE_PATH . LOC := GOAL; 
loop 

NEXT_LOC : = N_ARRAY ( GOAL ( 1 ) , GOAL ( 2 ) , GOAL ( 3 ) , 

GOAL (4) ) .PARENT; 
THE_PATH_CURRENT := new LIST; 

THE_PATH_CURRENT . LOC := NEXT_LOC; 
THE_PATH_CURRENT . NEXT := THE_PATH; 

THE_PATH := T H E_P AT H_CURRE NT; 

GOAL := NEXT_LOC; 

exit when THE PATH. LOC = START; 
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end loop; 

elsif GOAL_FOUND and THE_PATH /= null then 
loop 

NEXT_LOC : = N_ARRAY ( GOAL ( 1 ) , GOAL ( 2 ) , GOAL ( 3 ) , 

GOAL (4) ) .PARENT; 
THE_PATH_CURRENT := new LIST; 

THE_PATH_CURRENT . LOC := NEXT_LOC; 
THE_PATH_CURRENT . NEXT := THE_PATH; 

THE_PATH := THE_PATH_CURRENT; 

GOAL := NEXT_LOC; 
exit when THE_PATH . LOC = START; 
end loop; 
else 

put ("PATH NOT FOUND"); 
new_line; 
end if; 

while THE_PATH /= null loop 

INT_IO.put (PATH_FILE, THE_PATH . LOC ( 1 ) ) ; 
INT_IO.put (PATH_FILE, THE_PATH . LOC (2 ) ) ; 

INT_IO .put (PATH_FILE, THE_PATH . LOC ( 3 ) ) ; 

INT_IO . put (PATH_FILE, THE_PATH . LOC ( 4 ) ) ; 
new_line (PATH_FILE) ; 

THE_PATH := THE_PATH .NEXT; 
end loop; 

put (PATH_FILE, "END PATH SEGMENT"); 
new_line (PATH_FILE) ; 
end P_PATH; 

procedure F_MOVES (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

Using the heading of the current node being processed, 
F_MOVES determines the legal moves that can be made and 
calls the CHECK_??? procedure in the THE_MOVE package. 

HEADING : INT TYPE := ROOT.LOC(4); 



begin 

case HEADING is 
when 1 => 

CHECK_UP_NW (N_ARRAY, ROOT) ; 
CHECK_UP_N (N_ARRAY, ROOT) ; 
CHECK UP NE (N ARRAY, ROOT) ; 
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CHECK_NW (N_ARRAY, ROOT) ; 
CHECK_N (N_ARRAY, ROOT) ; 
CHECK_NE (N_ARRAY, ROOT) ; 
CHECK_DOWN_NW (N_ARRAY, ROOT) 
CHECK_DOWN_N ( N_ARRA Y , ROOT) ; 
CHECK_DOWN_NE (N_ARRAY, ROOT) 

when 2 => 

CHECK_UP_NE (N_ARRAY, ROOT) ; 
CHECK_UP_E (N_ARRAY, ROOT) ; 
CHECK_UP_SE (N_ARRAY, ROOT) ; 
CHECK_NE ( N_ARRA Y , ROOT) ; 
CHECK_E ( N_ARRA Y , ROOT) ; 
CHECK_SE (N_ARRAY, ROOT) ; 
CHECK_DOWN_NE (N_ARRAY, ROOT) 
CHECK_DOWN_E (N_ARRAY, ROOT) ; 
CHECK_DOWN_SE (N_ARRAY, ROOT) 

when 3 => 

CHECK_UP_SE (N_ARRAY, ROOT) ; 
CHECK_UP_S ( N_ARRA Y , ROOT) ; 
CHECK_UP_SW (N_ARRAY, ROOT) ; 
CHECK_SE ( N_ARRA Y , ROOT) ; 
CHECK_S (N_ARRAY, ROOT) ; 
CHECK_SW (N_ARRAY, ROOT) ; 
CHECK_DOWN_SE ( N_ARRAY , ROOT) 
CHECK_DOWN_S (N_ARRAY, ROOT) ; 
CHECK_DOWN_SW (N_ARRAY, ROOT) 

when 4 => 

CHECK_UP_SW (N_ARRAY, ROOT) ; 
CHECK_UP_W (N_ARRAY, ROOT) ; 
CHECK_UP_NW (N_ARRAY, ROOT) ; 
CHECK_SW (N_ARRAY, ROOT) ; 
CHECK_W ( N_ARRA Y , ROOT) ; 
CHECK_NW (N_ARRAY, ROOT); 
CHECK_DOWN_SW (N_ARRAY, ROOT) 
CHECK_DOWN_W (N_ ARRAY, ROOT) ; 
CHECK DOWN NW (N ARRAY, ROOT) 



when others => 
null; 
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end case; 
end F_MOVE S ; 

procedure FREE is new UNCHECKED_DEALLOCATION (LIST, 
LIST_PTR) ; 

Clears old memory space. 

procedure F_PATH (N_ARRAY : in out NODE_ARRAY) is 

Processes the WAVE list in order calling the F_MOVE 
procedure. Also reinitializes the WAVE list. 

ROOT : LIST PTR := WAVE; 



begin 

while ROOT /= null loop 
F_MOVES (N_ARRAY, ROOT) ; 

ROOT := WAVE. NEXT; 

FREE (WAVE) ; 

WAVE ;= ROOT; 
end loop; 

FREE (WAVE) ; 

if GOAL_FOUND then 
return; 
end if; 

WAVE := NEW_WAVE; 

NEW_WAVE := null; 

LAS T_NEW_WAVE ;= null; 
end F_PATH; 

procedure RESET_ALL (N_ARRAY : in out NODE_ARRAY) is 

Used to reset the various attributes in N_ARRAY changed 
during each path segment search. This allows a path to 
go to a waypoint/goal and return using many of the nodes 
previously used in the outbound trip. 

begin 

GOAL_FOUND ;= FALSE; 
for ROW in l..MAX_ROW loop 
for COL in l..MAX_COL loop 
for DEP in 1 . . MAX_DEP loop 
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for HDG in l..MAX_HDG loop 

N_ARRAY (ROW, COL, DEP, HDG) .PARENT := (others => 0) 
N_ARRAY (ROW, COL, DEP, HDG) . TEND_LEN := 0; 
end loop; 
end loop; 
end loop; 
end loop; 
end RESET ALL; 



procedure DO_SEARCH is 

Calls the major procedures in the search and creates the 
-- N_ARRAY . 

N_ARRAY : NODE_ARRAY (l..MAX_ROW, l..MAX_COL, 

1..MAX DEP, 1 . . MAX HDG); 



begin 

READ_TER (N_ARRAY) ; 

CREATE ( PATH_F I LE , NAME => "path . file" ) ; 
loop 

exit when WAVE_HEAD . NEXT = null; 

WAVE ;= new LIST; 

WAVE . LOC := WAVE_HEAD . LOC ; 

START := WAVE_HEAD . LOC; 

GOAL := WAVE_HEAD. NEXT. LOC; 

while WAVE /= null and NOT GOAL_FOUND loop 
F_PATH ( N_ARRA Y ) ; 
end loop; 

P_PATH (N_ARRAY) ; 

RESET_ALL ( N_ARRA Y ) ; 

WAVE_HEAD := WAVE_HEAD . NEXT ; 
end loop; 

CLOSE (PATH_FILE) ; 
end DO_SEARCH; 
end PATHWP ; 
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APPENDIX F (part 1) 

Table 1: Data Dictionary for the DIRECTION Search 



PACKAGE 

PROCEDURE 

VARIABLE 


TYPE 


GLOBALS 

DATA_FILE 


FELE_TYPE 


LOC.ARRAY 


array (1..4) of INT_TYPE 


LIST 


record {LOC : LOC_ARRAY 
NEXT : LIST_PTR} 


NODE 


record { STATE : INT_TYPE 

DIST : INT_TYPE := 0 
INC : INT.TYPE := 0 
NEXT : LOC ARRAY := 
(9,9,9, 9)} 


NODE_ARRAY 


array (INT_TYPE range o, 

INt tYPE range o, 

INT TYPE range o, 

INT TYPE range o) of NODE 


START_TIME 

END_TIME 


TIME 


T_TIME 


DURATION 


MAX.ROW 
MAX.COL 
MAX_DEP 
MAX_HDG 
DIAG.COST := 120 
CARD_COST := 100 


INT_TYPE 


ACTIVE 

TAIL 

CLEAR 

PATH 


LIST.PTR := null 


START 

GOAL 


LOC_ ARRAY 


GOAL.FOUND 


BOOLEAN := FALSE 
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Table 1: Data Dictionary for the DIRECTION Search 



PACKAGE 

PROCEDURE 

VARIABLE 


TYPE 


B 

GET DATA 
FILE_NAME 


STRING (1..12) 


NAME.LEN 


INT_TYPE 


E-PATH 

P_TAIL 


LIST_PTR := null 


FIND MOVES 

HDG : ACTIVE.LOC (4) 


INT_TYPE 


L 

NL 


LOC_ARRAY := ACTIVE.LOC 


FIND PATH 
F.TAIL 


LIST.PTR := null 


DO DIR 
N.ARRAY 


NODE_ARRAY (l..MAX_ROW, 

1.. MAX_COL, 

1.. MAX_DEP, 

1.. MAX_HDG) 



87 



DATA FLOW DIAGRAM for the DIRECTION SEARCH (part 2) 
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DIRECTION SEARCH CODE (part 3) 



— NAME 
— DATE 
— REVISED 
--TITLE 
— DESCRIPTION 
—CALLS : 

--NOTES 



J. Bonsignore, Jr. 

22 Jan, 1991 

DIRECT I ON. ADA 

Main procedure for the Direction search 
GET_DATA and DO_DIR in the B package (like PATH 
: package) . 



with TEXT_IO, A, B; 
use TEXT_IO, A, B; 

procedure DIRECTION is 

begin 

GET_DATA; 

DO_DIR; 

end DIRECTION; 
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--NAME : J. Bonsignore, Jr. 

— DATE : 22 Jan, 1991 

— REVISED : 

--TITLE : A. ADS 

— DESCRIPTION : Global variables for the Direction search 

— CALLS : 

--NOTES 



with TEXT_IO, CALENDAR; 
use TEXT_IO, CALENDAR; 

package A is 

subtype INT_TYPE is INTEGER; 

package INT_IO is new INTEGER_IO (INT_TYPE) ; 
package FLOATIO is new FLOAT_IO (FLOAT) ; 
use INT_IO, FLOATIO; 

type LOC_ARRAY is array (1..4) of INT_TYPE; 



type LIST; 

type LIST_PTR is access LIST; 
type LIST is 
record 

LOC : LOC_ARRAY ; 
NEXT : LIST_PTR; 
end record; 



ACTIVE : LIST_PTR; 
TAIL : LIST_PTR; 
CLEAR : LIST_PTR; 
PATH : LIST PTR; 



type NODE is 
record 

STATE 

DIST 

INC 

NEXT 

end record; 



: INT_TYPE 
: INT_TYPE 
: INT_TYPE 
: LOC ARRAY 



0 ; 

0 ; 

0 ; 

(9, 9,9,9); 
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type NODE_ARRAY is array (INT_TYPE range <>, INT_TYPE range 

<>, INT_TYPE range <>, INT_TYPE 
range <>) of NODE; 



DATA_FILE 


; FILE_TYPE; 




START_TIME 


; : TIME; 




END_TIME 


; TIME; 




T_TIME 


: DURATION; 




MAX_ROW : 


INT_TYPE; 




MAX_COL : 


INT_TYPE; 




MAX_DEP ; 


INT_TYPE; 




MAX_HDG ; 


INT_TYPE ;= 4; 




DIAG_COST 


: INT_TYPE := 


120; 


CARD_COST 


: INT_TYPE := 


100; 


GOAL : LOC_ARRAY; 




START ; LOC_ARRAY ; 





end A; 
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— NAME : J. Bonsignore, Jr. 

— DATE : 22 Jan, 1991 

--REVISED 

— TITLE : B.ADS 

— DESCRIPTION : This package is similar to the PATH package 

in other programs. 

: It contains the major procedures for the 

Direction search. 

--CALLS : 

—NOTES : 



with TEXT_IO, A, C, UNCHECKED_DEALLOCAT I ON , CALENDAR; 
use TEXT_IO, A, C, CALENDAR; 

package B is 

procedure DO_DIR; 

procedure GET_DATA; 

end B; 



— NAME 
--DATE 
— REVISED 
— TITLE 
— DESCRIPTION 



J. Bonsignore, Jr. 

22 Jan, 1991 

B.ADB 

Package body for the B package 



package body B is 

procedure GET_DATA is 

— Opens the Data file containing terrain information and gets 

— the array dimensions. It also takes as input the starting 

— and goal coordinates. 

F I LE_NAME : STRING (1..12); 

NAME LEN : INT TYPE; 
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begin 

put ("Enter the name of data file: "); 

get_line (FILE_NAME, NAME_LEN ) ; 

FILE_NAME ( (NAME_LEN + 1)..12) := (others => ’ • ); 

F I LE_NAME (9.. 12) := ".DAT"; 

OPEN (DATA_FILE, MODE => IN_FILE, NAME => F I LE_NAME ) ; 
INT_IO . get (DATA_FILE, MAX_ROW) ; 

INT_IO . get ( D AT A_F I LE , MAX_COL) ; 

INT_IO . get ( D AT A_F I LE , MAX_DEP) ; 

INT_IO.get (DATA_FILE, MAX_HDG) ; 

NEW_L I NE ; 

put ("Enter the starting row: ") ; 

INT_IO . get (START (1)); 

NEW_LINE; 

put ("Enter the starting col: "); 

INT_IO . get (START (2) ) ; 

NEW_LINE; 

put ("Enter the starting dep: "); 

INT_IO.get (START (3) ) ; 

NEW_LINE; 

put ("Enter the starting hdg: "); 

INT_IO.get (START (4) ) ; 

NEW_LINE; 

put ("Enter the goal row: "); 

INT_IO . get ( GOAL ( 1 ) ) ; 

NEW_LINE; 

put ("Enter the goal col: " ); 

INT_IO . get ( GOAL ( 2 ) ) ; 

NEW_LINE; 

put ("Enter the goal dep: ") ; 

INT_IO . get (GOAL (3) ) ; 

NEW_LINE; 

put ("Enter the goal hdg: "); 

INT_IO . get (GOAL ( 4 ) ) ; 

ACTIVE := new LIST; 

ACTIVE. LOC := GOAL; 
end GET_DATA; 

procedure READ_TER (N_ARRAY : in out NODE_ARRAY; 

D_F I LE : in out FILE_TYPE) is 

- Reads in the terrain data from the file and initializes the 
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N ARRAY. 



begin 



DEP, 



for ROW in l..MAX_ROW loop 
for COL in l..MAX_COL loop 

for DEP in l..MAX_DEP loop 
for HDG in l..MAX_HDG loop 
INT_IO. get (D_FILE, N_ARRAY (ROW, 

HDG) .STATE) ; 



end loop; 
end loop; 
end loop; 
end loop; 
close (D_FILE) ; 
end READ TER; 



COL, 



procedure FREE is new UNCHECKED_DEALLOCATION (LIST, 
LIST PTR) ; 



Used to free old memory space. 



procedure FIND_MOVES (N_ARRAY : in out NODE_ARRAY) is 

Using the REVERSE heading of the node being processed, 
FIND_MOVES determines which nodes can legally move into 
— it. This is OPPOSITE from the other search methods. Again 
procedures in the C package (just like THE_MOVE ) are 
called to process the individual nodes. 

HDG : INT_TYPE := ACTIVE. LOC (4) ; 

L : LOC_ARRAY := ACTIVE. LOC; 

NL : LOC_ARRAY := ACTIVE. LOC; 

begin 

while ACTIVE /= null loop 
HDG := ACTIVE. LOC (4) ; 

L := ACTIVE. LOC; 

NL := ACTIVE. LOC; 
case HDG is 

when 1 => 

S (L, NL, N_ARRAY) ; 

NL := L; 
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US (L, 


NL, 


N_ARRAY ) ; 


NL : = 


L; 






DS (L, 


NL, 


N_ARRAY ) ; 


NL : = 


L; 






NL (4) 


: = 


4; 




SE (L, 


NL, 


N ARRAY) ; 


NL ( 1 . . 


3) 


• — 
# 


L(l. .3) ; 


U SE (L, 


NL 


,, N ARRAY) 


NL ( 1 . . 


3) 


♦ — 
• 


L(l. .3) ; 


DSE (L 


'/ 


NL, 


N_ARRAY) ; 


NL ( 1 . . 


3) 


: = 


L<1..3); 


NL (4) 


l — 


2; 




SW (L, 


NL, 


N_ARRAY) ; 


NL ( 1 . . 


3) 


; — 


L ( 1 . . 3 ) ; 


USW (L 


/ 


NL, 


N ARRAY) ; 


NL ( 1 . . 


3) 


: = 


L ( 1 . . 3 ) ; 


DSW (L 


/ 


NL, 


N_ARRAY) ; 


when 2 = 


> 






W (L, 


NL 


,, N 


_ARRAY) ; 


NL : = 


L; 






UW (L, 


NL, 


N_ARRAY ) ; 


NL : = 


L; 






DW (L, 


NL, 


N_ARRAY) ; 


NL : = 


L; 






NL (4) 


: = 


3; 




NW (L, 


NL, 


N ARRAY) ; 


NL ( 1 . . 


3) 


; = 


L ( 1 . .3) ; 


UNW (L 


/ 


NL, 


N ARRAY) ; 


NL ( 1 . . 


3) 


# — 
# 


L ( 1 . . 3 ) ; 


DNW (L 


/ 


NL, 


N_ARRAY) ; 


NL : = 


L; 






NL (4) 


: = 


l; 




SW (L, 


NL, 


N_ARRAY) ; 


NL ( 1 . . 


3) 


# — 
♦ 


L(l. .3) ; 


USW (L 


/ 


NL, 


N ARRAY) ; 


NL ( 1 . . 


3) 


: = 


L ( 1 . . 3 ) ; 


DSW (L 


/ 


NL, 


N ARRAY) ; 



when 3 => 

N (L, NL, N_ARRAY) ; 
NL := L; 

UN (L, NL, N ARRAY) ; 
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NL := L; 

DN (L, NL, N_ARRAY) ; 
NL := L; 

NL (4 ) := 2; 

NW (L, NL, N_ARRAY) ; 
NL (1 . .3) := L (1 . .3) ; 
UNW (L, NL, N_ARRAY) ; 
NL (1 . .3) := L(l. .3) ; 

DNW (L, NL, N_ARRAY) ; 
NL := L; 

NL (4 ) := 4; 

NE (L, NL, N_ARRAY) ; 
NL ( 1 . .3) := L(l. .3) ; 
ONE (L, NL, N_ARRAY) ; 
NL ( 1 . .3) := L (1 . .3) ; 

DNE (L, NL, N_ARRAY) ; 

when 4 => 



E (L, 


NL, N 


_ARRAY) ; 


NL : = 


L; 




UE (L, 


NL, 


N_ARRAY) ; 


NL : = 


L; 




DE (L, 


NL, 


N_ARRAY) ; 


NL ; = 


L; 




NL (4 ) 


:= 3; 




NE (L, 


NL, 


N_ARRAY) ; 


NL (1 . . 


3) : = 


L(l. .3) ; 


UNE (L 


NL, 


N ARRAY) ; 


NL (1 . . 


3) : = 


L (1 . .3) ; 


DNE (L 


„ NL, 


N_ARRAY) ; 


NL : = 


L; 




NL (4 ) 


• • 
It 

M 




SE (L, 


NL, 


N_ARRAY) ; 


NL ( 1 . . 


3) ; = 


L(l. .3) ; 


U_SE (L, NL 


, N_ARRAY) ; 


NL ( 1 . . 


3) : = 


L (1 . .3) ; 


DSE (L 


,, NL, 


N ARRAY) ; 



when others => 
null; 



end case; 

CLEAR := ACTIVE; 
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ACTIVE := ACTIVE. NEXT; 

CLEAR. NEXT := null; 

FREE (CLEAR) ; 
end loop; 
end FIND_MOVES; 

procedure P_PATH is 

Processes the PATH list for printing. 

P_TAIL : LIST_PTR := PATH; 

begin 

loop 

put ( ' ( ' ) ; 

INT_IO . put (P_TAIL . LOC ( 1 ) ) ; 

INT_IO . put (P_TAIL.LOC (2) ) ; 

INT_IO . put (P_TAIL.LOC (3) ) ; 

INT_IO . put (P_TAIL.LOC (4) ) ; 
put ( ' ) ' ) ; 

NEW_LINE; 

exit when P_TAIL.LOC = GOAL; 

P_TAIL := P_TAIL . NEXT; 
end loop; 
end P PATH; 



procedure FIND_PATH (N_ARRAY : in out NODE_ARRAY ) is 

Used to process the PATH list adding nodes as the vectors 
are traced. 

F_TAIL : LIST_PTR; 

begin 

F_TAIL := new LIST; 

F_TAIL . LOC := START; 

PATH := F_TAIL; 
loop 

exit when F_TAIL.LOC = GOAL; 

F_TAIL . NEXT := new LIST; 

F_TAIL. NEXT. LOC := N_ARRAY (F_TAIL . LOC ( 1 ) , F_TAIL . LOC (2 ) , 

F_TAIL.LOC (3) , F_TAIL . LOC (4 ) ) .NEXT; 
F TAIL := F TAIL. NEXT; 
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end loop; 
end FIND PATH; 



procedure DO_DIR is 

— Creates the N_ARRAY dynamically and calls the major 

— procedures for the search. Some timing constructs are 

— added for evaluation purposes. 

N_ARRAY : NODE_ARRAY ( 1 . . MAX_ROW, 1 . . MAX_COL, 

1 . . MAX DEP, 1 . .MAX HDG) ; 



begin 

START_TIME := CLOCK; 

READ_TER (N_ARRAY, DATA_FILE) ; 

F I ND_MOVE S ( N_ARRAY ) ; 

FIND_PATH (N_ARRAY) ; 

P_PATH; 

END_TIME := CLOCK; 

T_TIME := END_TIME - S TART_T I ME ; 
FLOATIO . put (FLOAT (T_TIME) ) ; 
put (" seconds."); 

NEW_LINE; 
end DO_DIR; 

end B; 
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— NAME 
--DATE 
—REVISED 
--TITLE 
— DESCRIPTION 

— CALLS 
— NOTES 



J. Bonsignore, Jr. 

22 Jan, 1991 

C.ADS 

The package containing THE_MOVE type 
procedures 

Although similar to THE_MOVE in other 
programs, the procedures are somewhat 
different due to the "reverse" nature of the 
search . 



with TEXT_IO, A; 
use TEXT_IO, A; 

package C is 



procedure A_AND_A (L 

NL 

N_ARRAY 

I 



in 


out 


LOC_ 


ARRAY; 


in 


out 


LOC 


ARRAY; 


in 


out 


NODE_ARRAY ; 


in 


out 


INT 


TYPE) ; 



procedure N 



(L 

NL 

N ARRAY 



in out LOC_ARRAY; 
in out LOC_ARRAY; 
in out NODE ARRAY) ; 



procedure 



NE (L 
NL 

N ARRAY 



in out LOC_ARRAY; 
in out LOC_ARRAY; 
in out NODE ARRAY) ; 



procedure E (L : 

NL : 

N_ ARRAY : 

procedure SE (L : 

NL : 

N_ARRAY : 

procedure S (L : 

NL : 

N ARRAY : 



in out LOC_ARRAY; 
in out LOC_ARRAY ; 
in out NODE_ARRAY ) ; 

in out LOC_ARRAY; 
in out LOC_ARRAY ; 
in out NODE_ARRAY ) ; 

in out LOC_ARRAY ; 
in out LOC_ARRAY ; 
in out NODE ARRAY) ; 
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procedure SW (L 
NL 

N_ARRAY 

procedure W (L : 

NL : 

N_ARRAY : 

procedure NW (L 
NL 

N_ARRAY 

procedure UN (L 
NL 

N_ARRAY 

procedure UNE (L 

NL 

N_ARRAY 

procedure UE (L 
NL 

N_ARRAY 

procedure U_SE (L 

NL 

N_ARRAY 

procedure US (L : 

NL : 

N_ARRAY : 

procedure USW (L 

NL 

N_ARRAY 

procedure UW (L : 

NL : 

N_ARRAY : 

procedure UNW (L 

NL 



: in out LOC ARRAY; 

: in out LOC_ARRAY ; 

: in out NODE_ARRAY) ; 

in out LOC_ARRAY ; 
in out LOC_ARRAY ; 
in out NODE_ARRAY ) ; 

in out LOC_ARRAY; 
in out LOC_ARRAY ; 
in out NODE_ARRAY ) ; 

in out LOC_ARRAY; 
in out LOC_ARRAY ; 
in out NODE_ARRAY) ; 

in out LOC_ARRAY ; 
in out LOC_ARRAY ; 
in out NODE_ARRAY ) ; 

in out LOC_ARRAY ; 
in out LOC_ARRAY ; 
in out NODE_ARRAY ) ; 

: in out LOC_ARRAY; 

: in out LOC_ARRAY ; 

: in out NODE_ARRAY) ; 

in out LOC_ARRAY; 
in out LOC_ARRAY; 
in out NODE_ARRAY ) ; 

in out LOC_ARRAY ; 
in out LOC_ARRAY ; 
in out NODE_ARRAY) ; 

in out LOC_ARRAY; 
in out LOC_ARRAY; 
in out NODE_ARRAY ) ; 

in out LOC_ARRAY ; 
in out LOC ARRAY; 
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N_ARRAY 

procedure DN (L : 

NL 

N_ARRAY : 

procedure DNE (L 

NL 

N_ARRAY : 

procedure DE (L : 

NL : 

N_ARRAY : 

procedure DSE (L 

NL 

N_ARRAY 

procedure DS (L : 

NL : 

N_ARRAY : 

procedure DSW (L 

NL 

N_ARRAY 

procedure DW (L : 

NL : 

N_ARRAY : 

procedure DNW (L 

NL 

N ARRAY 



: in out NODE_ARRAY) / 

in out LOC_ARRAY; 
in out LOC_ARRAY ; 
in out NODE_ARRAY ) ; 

: in out LOC_ARRAY; 

: in out LOC_ARRAY; 
in out NODE_ARRAY ) ; 

in out LOC_ARRAY ; 
in out LOC_ARRAY; 
in out NODE_ARRAY) ; 

: in out LOC_ARRAY; 

: in out LOC_ARRAY ; 

: in out NODE_ARRAY ) ; 

in out LOC_ARRAY; 
in out LOC_ARRAY; 
in out NODE_ARRAY ) ; 

: in out LOC_ARRAY; 

: in out LOC_ARRAY; 

: in out NODE_ARRAY) ; 

in out LOC_ARRAY; 
in out LOC_ARRAY; 
in out NODE_ARRAY ) ; 

: in out LOC_ARRAY; 

: in out LOC_ARRAY; 

: in out NODE ARRAY) ; 



end C; 



— NAME 
— DATE 
— REVISED 
— TITLE 
— DESCRIPTION 



J. Bonsignore, Jr. 

22 Jan, 1991 

C.ADS 

The package body for the C package 
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package body C is 



procedure A_AND_A (L 

NL 

N_ARRAY 

I 



: in out LOC_ARRAY; 

: in out LOC_ARRAY ; 

: in out NODE_ARRAY ; 

: in out INT TYPE) is 



— Analyzes and assigns the legal nodes to the ACTIVE list and 
sets the various attributes in the N ARRAY node. 



begin 

if N_ARRAY(NL(1) , NL(2), NL(3), NL (4)). STATE = 0 then 
if N_ARRAY (NL ( 1 ) , NL(2), NL(3), NL(4)).DIST = 0 
then 

if ACTIVE. NEXT = null then 
TAIL := new LIST; 

TAIL . LOC := NL; 

ACTIVE. NEXT := TAIL; 

else 

TAIL. NEXT := new LIST; 

TAIL := TAIL .NEXT; 

TAIL. LOC := NL; 

end if; 

N_ARRAY (NL ( 1 ) , NL ( 2 ) , NL ( 3 ) , NL ( 4 ) ) . NEXT := L; 
N_ARRAY (NL (1) , NL (2) ,NL (3) , NL (4) ) . INC := I; 
N_ARRAY (NL (1) , NL (2 ) , NL (3) , NL (4 ) ) . DIST := 
N_ARRAY (L (1) , L (2) , L (3) , L (4 ) ) .DIST + I; 
end if; 
end if; 
end A AND A; 



— The following procedures all determine the coordinates for 
the given move based on the current node coordinates. 
Calls the A_AND_A procedure. 



procedure N (L 


: in 


out 


LOC_ARRAY; 


NL 


: in 


out 


LOC_ARRAY ; 


N_ARRAY 


: in 


out 


NODE_ARRAY) is 


begin 








if L ( 1 ) > 1 


then 
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NL ( 1 ) : = NL ( 1 ) - 1; 

A _ANE)_ A (L, NL, N_ARRAY, C A RD_COST) ; 
end if; 

end N; 



procedure NE 



(L 

NL 

N ARRAY 



in out LOC_ARRAY; 
in out LOC_ARRAY ; 
in out NODE ARRAY) is 



begin 

if L(l) >1 and L(2) < M A X_COL then 
NL ( 1 ) := NL ( 1 ) - 1; 

NL (2 ) := NL (2) + 1; 

A _ A ND_ A (L, NL, N_ A RRAY, DIAG_COST) ; 
end if; 

end NE; 



procedure E (L : in out LOC_ARRAY; 

NL : in out LOC_ARRAY; 

N_ARR A Y : in out NODE_ARRAY) is 

begin 

if L (2) < M A X_COL then 
NL (2) := NL (2) + 1; 

A _AND_A (L, NL, N_ARRAY, CARD_COST) ; 
end if; 

end E; 



procedure SE 



(L 

NL 

N ARRAY 



in out LOC_ARRAY; 
in out LOC_ARRAY; 
in out NODE ARRAY) is 



begin 

if L(l) < MAX_ROW and L(2) < MAX_COL then 
NL ( 1 ) := NL ( 1 ) + 1; 

NL (2 ) := NL(2) + 1; 

A_AND_A (L, NL, N_ARRAY, DIAG_COST) ; 
end if; 

end SE; 



procedure S 



(L 

NL 

N ARRAY 



in out LOC_ARRAY; 
in out LOC_ARRAY; 
in out NODE ARRAY) is 
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begin 



if L(l) < MAX_ROW then 
NL ( 1 ) := NL ( 1 ) + 1; 

A _AND_A (L, NL, N_ARRAY, CARD_COST) 
end if; 

end S; 



procedure SW 



(L 

NL 

N ARRAY 



in out LOC_ARRAY; 
in out LOC_ARRAY; 
in out NODE ARRAY) is 



begin 

if L ( 1 ) < MAX_ROW and L(2) >1 then 
NL (1 ) := NL ( 1 ) + 1; 

NL (2) := NL (2) - 1; 

A_AND_A (L, NL, N_ARRAY, DIAG_COST) 
end if; 

end SW; 



procedure W 



(L 

NL 

N ARRAY 



in out LOC_ARRAY; 
in out LOC_ARRAY; 
in out NODE ARRAY) is 



begin 

if L(2) > 1 then 

NL (2) := NL(2) - 1; 

A_AND_A (L, NL, N_ARRAY, CARD_COST) 
end if; 

end W; 



procedure NW 



(L 

NL 

N ARRAY 



in out LOC_ARRAY; 
in out LOC_ARRAY; 
in out NODE ARRAY) is 



begin 

if L ( 1 ) > 1 and L(2) > 1 then 
NL ( 1 ) := NL ( 1 ) - 1; 

NL (2) := NL (2) - 1; 

A_AND_A (L, NL, N_ARRAY, DIAG_COST) 
end if; 

end NW; 
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procedure UN (L : in out LOC_ARRAY; 

NL : in out LOC_ARRAY; 

N ARRAY : in out NODE ARRAY) is 



begin 

if L(l) > 1 and L(3) > 1 then 
NL ( 1 ) := NL (1) - 1; 

NL (3 ) := NL (3) - 1; 

A_AND_A (L, NL, N_ARRAY , DIAG_COST) ; 
end if; 

end UN; 

procedure UNE (L : in out LOC_ARRAY; 

NL : in out LOC_ARRAY; 

N_ARRAY : in out NODE_ARRAY) is 

begin 

if L ( 1 ) >1 and L(2) < MAX_COL and L(3) >1 then 
NL ( 1 ) : = NL ( 1 ) - 1; 

NL (2) := NL (2) + 1; 

NL (3) := NL (3) - 1; 

A_AND_A (L, NL, N_ARRAY, DIAG_COST) ; 
end if; 
end UNE; 

procedure UE (L : in out LOC_ARRAY; 

NL ; in out LOC_ARRAY; 

N_ARRAY : in out NODE_ARRAY) is 

begin 

if L (2) < MAX_COL and L(3) >1 then 
NL (2) := NL (2 ) + 1; 

NL (3) ;= NL (3) - 1; 

A_AND_A (L, NL, N_ARRAY, DIAG_COST) ; 
end if; 

end UE; 

procedure U_SE (L ; in out LOC_ARRAY; 

NL ; in out LOC_ARRAY; 

N ARRAY : in out NODE ARRAY) is 



begin 

if L(l) < MAX ROW and L(2) < MAX COL and L(3) > 1 
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then 



NL (1 ) := NL ( 1 ) + 1; 

NL (2) := NL (2) + 1; 

NL (3) := NL (3) - 1; 

A _AND_ A (L, NL, N_ A RRA.Y, DI A G_COST) ; 
end if; 
end U_SE; 

procedure US (L : in out LOC_ A RR A Y; 

NL : in out LOC_ A RR A Y; 

N_ A REl A Y : in out NODE_ A RR A Y) is 

begin 

if L ( 1 ) < M A X_ROW and L(3) >1 then 
NL (1 ) ; = NL ( 1 ) + 1; 

NL (3) := NL (3) - 1; 

A_AND_A (L, NL, H_ARRAY , DI A G_COST) ; 
end if; 

end US; 

procedure USW (L : in out LOC_ARRAY; 

NL : in out LOC_ARRAY; 

N ARRAY : in out NODE ARRAY) is 



begin 

if L(l) < M A X_ROW and L(2) > 1 and L(3) > 
NL ( 1 ) := NL ( 1 ) + 1; 

NL (2) ;= NL (2) - 1; 

NL (3) ;= NL (3) - 1; 

A _ AND _ A (L, NL, N_ A RRAY, DI A G_COST) ; 
end if; 
end USW; 

procedure UW (L ; in out LOC_ A RRA.Y; 

NL : in out hOC_ARRAY; 

N MIRAY : in out NODE A RRA.Y) is 



begin 

if L (2 ) >1 and L(3) >1 then 
NL (2) := NL (2 ) - 1; 

NL (3) := NL (3) - 1; 

A _ A ND_ A (L, NL, N_ A RRA.Y, DI A G_COST) ; 
end if; 



1 then 
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end UW; 



procedure UNW (L : in out LOC_ARRAY; 

NL : in out LOC_ARRAY; 

N_ARRAY : in out NODE_ARRAY ) is 

begin 

if L ( 1 ) > 1 and L(2) > 1 and L(3) > 1 then 
NL ( 1 ) := NL ( 1 ) - 1; 

NL (2 ) := NL(2) - 1; 

NL (3) := NL ( 3 ) - 1; 

A_AND_A (L, NL, N_ARRAY, DIAG_COST) ; 
end if; 
end UNW; 

procedure DN (L : in out LOC_ARRAY; 

NL : in out LOC_ARRAY; 

N_ARRAY : in out NODE_ARRAY ) is 

begin 

if L(l) >1 and L(3) < MAX_DEP then 
NL ( 1 ) := NL (1) - 1; 

NL ( 3 ) := NL(3) + 1; 

A_AND_A (L, NL, N_ARRAY, DIAG_COST) ; 
end if; 

end De- 
procedure DNE (L : in out LOC_ARRAY; 

NL : in out LOC_ARRAY ; 

N_ARRAY ; in out NODE_ARRAY ) is 

begin 

if L ( 1 ) >1 and L(2) < MAX_COL and L(3) < MAX_DEP 
then 

NL ( 1 ) := NL ( 1 ) - 1; 

NL (2 ) ;= NL(2) + 1; 

NL (3) := NL (3 ) + 1; 

A_AN D _A (L, NL, N_ARRAY, DIAG_COST) ; 
end if; 
end DNE; 



procedure DE (L : in out LOC ARRAY; 
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begin 



NL : in out LOC_ARRAY; 

N ARRAY : in out NODE ARRAY) is 



if L (2) < MAX_COL and L(3) < MAX_DEP then 
NL (2) := NL (2) + 1; 

NL (3) := NL (3) + 1; 

A_AND_A (L, NL, N_ARRAY, DIAG_COST) ; 
end if; 

end DE; 



procedure DSE (L : in out LOC_ARRAY; 

NL : in out LOC_ARRAY; 

N ARRAY ; in out NODE ARRAY) is 



begin 

if L(l) < MAX_ROW and L(2) < MAX_COL and L(3) < 
MAX_DEP then 
NL ( 1 ) := NL ( 1 ) + 1; 

NL (2) ;= NL (2) + 1; 

NL (3) := NL (3) + 1; 

A_AND_A (L, NL, N_ARRAY, DIAG_COST) ; 
end if; 
end DSE; 

procedure DS (L ; in out LOC_ARRAY; 

NL : in out LOC_ARRAY; 

N_ARRAY ; in out NODE_ARRAY) is 

begin 

if L ( 1 ) < MAX_ROW and L(3) < MAX_DEP then 
NL (1 ) := NL (1 ) + 1; 

NL (3) := NL (3) + 1; 

A_AND_A (L, NL, N_ARRAY, DIAG_COST) ; 
end if; 

end DS; 

procedure DSW (L ; in out LOC_ARRAY; 

NL : in out LOC_ARRAY ; 

N ARRAY : in out NODE ARRAY) is 



begin 
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if L ( 1 ) < MAX_ROW and L(2) >1 and L(3) < MAX_DEP 

then 

NL(1) := NL ( 1 ) + 1; 

NL (2 ) := NL (2) - 1; 

NL (3) := NL (3) + 1; 

a _ and _ a (L, NL, N_ARRAY, DIAG_COST) ; 
end if; 
end DSW; 

procedure DW (L : in out LOC_ARRAY; 

NL : in out LOC_ARRAY; 

N ARRAY : in out NODE ARRAY) is 



begin 

if L (2) >1 and L(3) < MAX_DEP then 
NL (2) := NL (2) - 1; 

NL (3) := NL (3) + 1; 





A_ 


AND A (L, 


NL, N ARRAY, DIAG COST) ; 




end 


if; 








end DW; 












procedure 


DNW 


(L 


: in 


out 


LOC_ARRAY ; 






NL 


: in 


out 


LOC_ARRAY ; 






N ARRAY 


: in 


out 


NODE ARRAY) is 



begin 

if L ( 1 ) >1 and L(2) >1 and L(3) < MAX_DEP then 
NL ( 1 ) := NL ( 1 ) - 1; 

NL (2) := NL (2) - 1; 

NL (3) := NL (3) + 1; 

A_AND_A (L, NL, N_ARRAY, DIAG_COST) ; 
end if; 
end DNW; 

end C; 
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APPENDIX G (part 1) 



Table 1: Data Dictionary for the RTA* Search 



PACKAGE 

PROCEDURE 

VARIABLE 


TYPE 


PATHWP 
GET DATA 

FILE.NAME 


STRING (1.. 12) 


NAME_LEN 


INT_TYPE 


P PATH 
NEXT.LOC 


LOC.ARRAY 


F MOVES 
HEADING 


INT_TYPE := ROOT.LOC (4) 


PICK NODE 
ASTAR_COST 


INTEGER := 999 


LEAST COST 

ROW_COST 

COL_COST 

DEP.COST 

HDG_COST 

NEW_COST 


INTEGER := 0 


DO SEARCH 
N.ARRAY 


NODE.ARRAY (l..MAX_ROW, 

1.. MAX_COL,‘ 

1.. MAX_DEP, 

1.. MAX_HDG) 
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DATA FLOW DIAGRAM for the RTA* SEARCH (part 2) 




NEW_ELE 
N ARRAY 
ROOT 



NEW_WAVE 
ASTAR.COST 
N ARRAY 



NEW_LOC 
N ARRAY 
COST 
ROOT 




N ARRAY 
ECE 



- ROOT 



V \ ELE 

V A «i r J\ NEW WAVE 
/ ASSIGNj NW Tail 
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REAL-TIME A* SEARCH CODE (part 3) 



— NAME 
— DATE 
—REVISED 
—TITLE 
—DESCRIPTION 
— CALLS 



— NOTES 



J. Bonsignore, Jr. 

22 Jan, 1991 

RTA.ADA 

Main procedure for the RTA* search 
GET_DATA and DO_SEARCH in another PATH 
package for 
the RTA. 



with TEXT_IO, GLOBALS, PATH; 
use TEXT_IO, GLOBALS, PATH; 

procedure RTA is 

begin 

GET_DATA; 

DO_SEARCH; 
end RTA; 
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— NAME 
— DATE 
--REVISED 
— TITLE 
—DESCRIPTION 

— CALLS 
— NOTES 



J. Bonsignore, Jr. 

22 Jan, 1991 

PATH. ADS 

Contains the major procedures for the RTA 
search 



with TEXT_IO, GLOBALS, THE_MOVE, UNCHECKED_DEALLOCAT I ON ; 
use TEXT_IO, GLOBALS, THE_MOVE ; 

package PATH is 

procedure DO_SEARCH; 

procedure GET_DATA; 

procedure READ_TER (N_ARRAY : in out NODE_ARRAY ) ; 
procedure P_PATH (N_ARRAY : in out NODE_ARRAY ) ; 
end PATH; 



— NAME 
— DATE 
— REVISED 
— TITLE 
—DESCRIPTION 



J. Bonsignore, Jr. 

22 Jan, 1991 

PATH . ADB 

Package body for the Path package used for 
the RTA search. 



package body PATH is 

procedure GET_DATA is 
— SAME AS OTHER PATH PACKAGE. 
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FILE_NAME : STRING (1..12); 

NAME_LEN : INT_TYPE; 

begin 

put ("Enter the name of data file: "); 

get_line (FILE_NAME, NAME_LEN) ; 

FILE_NAME ( (NAME_LEN + 1)..12) := (others => ' ' ); 

FILE_NAME (9.. 12) := ".DAT"; 

OPEN (DATA_FILE, MODE => IN_FILE, NAME => FILE_NAME) 
INT_I 0 . ge t ( DATA_F I LE , MAX_ROW ) ; 

INT_IO.get (DATA_FILE, MAX_COL) ; 

INT_IO. get (DATA_FILE, MAX_DEP) ; 

INT_IO.get (DATA_FILE, MAX_HDG) ; 

NEW_LINE; 

put ("Enter the starting row: " ) ; 

INT_IO. get (START (1 ) ) ; 

NEW_LINE; 

put ("Enter the starting col: ") ; 

INT_IO. get (START (2)); 

NEW_LINE; 

put ("Enter the starting dep: "); 

INT_IO.get (START (3) ) ; 

NEW_LINE; 

put ("Enter the starting hdg: "); 

INT_IO.get (START (4)); 

NEW_LINE; 

put ("Enter the goal row: "); 

INT_IO.get (GOAL (1) ) ; 

NEW_LINE; 

put ("Enter the goal col: ") ; 

INT_IO.get (GOAL (2) ) ; 

NEW_LINE; 

put ("Enter the goal dep: "); 

INT_IO.get ( GOAL ( 3 ) ) ; 

NEW_LINE; 

put ("Enter the goal hdg: ") ; 

INT_IO.get ( GOAL ( 4 ) ) ; 

WAVE := new LIST; 

WAVE . LOC := START; 

WAVE. INC := 0; 
end GET_DATA; 

procedure READ_TER (N ARRAY : in out NODE ARRAY ) is 
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SAME AS OTHER PATH PACKAGE. 



begin 

for ROW in l..MAX_ROW loop 
for COL in l..MAX_COL loop 

for DEP in l..MAX_DEP loop 
for HDG in l..MAX_HDG loop 
INT_IO.get ( DATA_F I LE , N_ARRAY (ROW, COL, 

DEP, HDG) . STATE) ; 
N_ARRAY (ROW, COL, DEP, HDG) . TEND_LEN := 0; 
N_ARRAY (ROW, COL, DEP, HDG). PARENT := 

( 0 , 0 , 0 , 0 ); 

end loop; 
end loop; 
end loop; 
end loop; 

close ( D AT A_F I LE ) ; 
end READ_TER; 

procedure P_PATH (N_ARRAY : in out NODE_ARRAY) is 
SAME AS OTHER PATH PACKAGE. 

NEXT LOC : LOC ARRAY; 



begin 

if GOAL FOUND then 



put ( ' ( ' ) ; 

INT_IO .put ( GOAL ( 1 ) ) ; 

INT_IO . put ( GOAL ( 2 ) ) ; 

INT_IO . put ( GOAL ( 3 ) ) ; 

INT_IO . put ( GOAL ( 4 ) ) ; 
put (')'); 
new_line; 

NEXT_LOC : = N_ARRAY (GOAL ( 1 ) , GOAL ( 2 ) , 
GOAL (4) ) .PARENT; 



while NEXT_LOC /= START loop 
put ( ' ( ' ) ; 



INT_IO . put 
INT_IO . put 
INT_IO .put 
INT_IO . put 



(NEXT_LOC (1) ) ; 
(NEXT_LOC (2) ) ; 
(NEXT_LOC (3) ) ; 
(NEXT LOC (4) ) ; 



GOAL (3) , 
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put (')'); 



NEXT_LOC := N_ARRAY (NEXT_LOC (1) , NEXT_L0C(2), 
NEXT_LOC ( 3 ) , 

NEXT_LOC (4) ) .PARENT; 

NEW_LINE; 
end loop; 



put (’('); 
INT_IO.put 
INT_IO .put 
INT_IO.put 
INT_IO.put 
put ( • ) ' ) ; 
new_line; 
INT_IO . put 

new_line; 

else 



(START (1) ) ; 
(START (2) ) ; 
(START (3) ) ; 
(START (4) ) ; 



(N_ARRAY ( GOAL ( 1 ) , GOAL (2), GOAL (3), 
GOAL (4) ) .TEND LEN) ; 



put ("PATH NOT FOUND"); 
new_line; 
end if; 
end P PATH; 



procedure F_MOVES (N_ARRAY ; in out NODE_ARRAY ; 

ROOT ; in out LIST_PTR) is 

SAME AS OTHER PATH PACKAGE. 

HEADING ; INT TYPE ;= ROOT.LOC(4); 



begin 

case HEADING is 
when 1 => 

CHECK_UP_NW (N_ARRAY, ROOT) ; 
CHECK_UP_N (N_ARRAY, ROOT) ; 
CHECK_UP_NE (N_ARRAY, ROOT) ; 
CHECK_NW (N_ARRAY, ROOT) ; 
CHECK_N (N_ARRAY, ROOT) ; 
CHECK_NE (N_ARRAY, ROOT) ; 
CHECK_DOWN_NW ( N_ARRA Y , ROOT) ; 
CHECK_DOWN_N ( N_ARRA Y , ROOT) ; 
CHECK_DOWN_NE (N_ARRAY, ROOT) ; 

when 2 => 
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CHECK_UP_NE (N_ARRAY, ROOT) ; 
CHECK_UP_E (N_ARRAY, ROOT) ; 
CHECK_UP_SE (N_ARRAY, ROOT) ; 
CHECK_NE (N_ARRAY, ROOT) ; 
CHECK_E ( N_ARRA Y , ROOT) ; 
CHECK_SE (N_ARRAY, ROOT) ; 
CHECK_DOWN_NE (N_ARRAY, ROOT) ; 
CHECK_DOWN_E (N_ARRAY, ROOT) ; 
CHECK_DOWN_SE (N_ARRAY, ROOT) ; 

when 3 => 

CHECK_UP_SE (N_ARRAY, ROOT) ; 
CHECK__UP_S (N_ARRAY, ROOT) ; 
CHECK_UP_SW (N_ARRAY, ROOT) ; 
CHECK_SE (N_ARRAY, ROOT) ; 
CHECK_S (N_ARRAY, ROOT) ; 
CHECK_SW (N_ARRAY, ROOT) ; 
CHECK_DOWN_SE (N_ARRAY, ROOT) ; 
CHECK_DOWN_S (N_ARRAY, ROOT) ; 
CHECK_DOWN_SW (N_ARRAY, ROOT) ; 

when 4 => 

CHECK_UP_SW (N_ARRAY, ROOT) ; 
CHECK_UP_W <N_ARRAY, ROOT) ; 
CHECK_UP_NW (N_ARRAY, ROOT) ; 
CHECK_SW (N_ARRAY, ROOT) ; 
CHECK_W (N_ARRAY, ROOT) ; 
CHECK_NW (N_ARRAY, ROOT) ; 
CHECK_DOWN_SW (N_ARRAY , ROOT) ; 
CHE CK_D OWN_W (N_ARRAY, ROOT) ; 
CHECK_DOWN_NW (N_ARRAY, ROOT) ; 

when others => 
null; 



end case; 
end F_MOVES; 

procedure FREE is new UNCHECKED_DEALLOCATION (LIST, 

LIST PTR) 



SAME AS OTHER PATH PACKAGE. 
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procedure F_FRONT (N_ARRAY : in out NODE_ARRAY) is 

This procedure makes two calls to the F_MOVES procedure. 
Each call extends the search depth an additional node 
distance. For further frontier nodes subsequent calls to 
F_MOVES can be made. 

begin 

F_MOVES (N_ARRAY, WAVE) ; 

WAVE := NEW_WAVE; 

NEW_WAVE := null; 
while WAVE /= null loop 
TRASH := WAVE; 

F_MOVES (N_ARRAY, WAVE) ; 

WAVE := WAVE. NEXT; 

FREE (TRASH) ; 
end loop; 
end F_FRONT; 

procedure PICK_NODE (N_ARRAY : in out NODE_ARRAY) is 

Estimates the cost to reach the GOAL from the frontier 
nodes and picks the least cost frontier node for further 
expansion. This is currently working in a limited manner. 
Absolute values must be used during the substraction 
of the GOAL from the LOC. 

AS T AR_CO S T : INTEGER := 999; 

procedure LEAST_COST (LOC ; in out LIST_PTR; 

AS T AR_CO S T : in out INTEGER; 
N_ARRAY : in N ODE_ARRA Y ) is 

Estimates the cost to the GOAL and assigns that nodes 
coordinates to ASTAR_ 

COST if it is less then previously processed nodes cost. 



ROW_COST 


INTEGER 


= 0; 


COL_COST 


INTEGER 


= 0; 


DEP_COST 


INTEGER 


= 0; 


HDG_COST 


INTEGER 


II 

o 


NEW COST 


INTEGER 


II 

o 

># 
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begin 

ROW_COST 
COL_COST 
DEP_COST 
HDG_COST 
NEW COST 



GOAL ( 1 ) - LOC . LOC ( 1 ) ; 
GOAL (2) - LOC. LOC (2) ; 
GOAL ( 3 ) - LOC . LOC ( 3 ) ; 
GOAL ( 4 ) - LOC . LOC ( 4 ) ; 
ROW_COST + COL_COST + 
+ N_ARRAY (LOC.LOC (1) , 
LOC. LOC (3) , 

if NEW_COST < ASTAR_COST then 
ASTAR_COST : = NEW_COST; 

WAVE := new LIST; 

WAVE. LOC := NEW_WAVE . LOC ; 
end if; 

end LEAST COST; 



DEP_COST + HDG_COST 
LOC.LOC (2) , 

LOC.LOC (4) ) .TEND LEN 



begin 

while NEW_WAVE /= null loop 

LEAST_COST (NEW_WAVE, ASTAR_COST, N_ARRAY) ; 
if NEW_WAVE . LOC = GOAL then 
GOAL_FOUND := TRUE; 
end if; 

exit when GOAL_FOUND ; 

NEW_WAVE := NEW_WAVE . NEXT; 
end loop; 

P_NODE (WAVE) ; 
end PICK_NODE; 

procedure DO_SEARCH is 

Calls the major procedures in the search and creates the 
N_ARRAY. 

N_ARRAY : NODE_ARRAY (l..MAX_ROW, l..MAX_COL, 

1 . . MAX_DEP , 1 . . MAX_HDG) ; 

begin 

READ_TER (N_ARRAY) ; 
while not GOAL_FOUND loop 
F_FRONT (N_ARRAY) ; 

P ICK_NODE (N_ARRAY) ; 
while NEW_WAVE /= null loop 
TRASH := NEW WAVE; 
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NEW_WAVE := NEW_WAVE .NEXT; 

FREE (TRASH) ; 
end loop; 

NEW_WAVE := null; 
end loop; 

GOAL := WAVE.LOC; -- Just for testing purposes! 
GOAL_FOUND := TRUE; — Just for testing purposes! 
P_PATH (N_ARRAY) ; 
end DO_SEARCH; 

end PATH; 



120 



J. Bonsignore, Jr. 
22 Jan, 1991 



--NAME 
— DATE 
--REVISED 
--TITLE 
— DESCRIPTION 

— CALLS 
--NOTES 

with TEXT_IO, GLOBALS; 
use TEXT_IO, GLOBALS; 

package THE_MOVE is 

procedure NNC (ELEMENT : in LIST_PTR; 

HEAD : in out LIST_PTR; 

TAIL : in out LIST_PTR) ; 

procedure GROW_TEND (ELE : in out LIST_PTR; 

N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) ; 

procedure CK_STATE (NEW_LOC : in out LOC_ARRAY ; 

N_ARRAY : in out NODE_ARRAY ; 

NEW_INC : in out INT_TYPE; 

ROOT ; in out LIST_PTR) ; 

procedure CHECK_N (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_UP_N (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_DOWN_N (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_NE (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_UP_NE (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST PTR) ; 



THE_MOVE . ADS 

Package containing the procedures for 
individual node processing. 
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procedure CHECK_DOWN_NE (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_E (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_UP_E (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_DOWN_E (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_SE (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_UP_SE (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_DOWN_SE (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) 

procedure CHECK_S (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_UP_S (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_DOWN_S (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_SW (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_UP_SW (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_DOWN_SW (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_W (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK UP_W (N_ARRAY : in out NODE ARRAY; 
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ROOT : in out LIST_PTR) ; 

procedure CHECK_DOWN_ W (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_NW (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_UP_NW (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) ; 

procedure CHECK_DOWN_NW (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST PTR) ; 



end THE MOVE; 



— NAME 
— DATE 
— REVISED 
— TITLE 
— DESCRIPTION 



J. Bonsignore, Jr. 

22 Jan, 1991 

THE_MOVE . ADB 

Package body for THE_MOVE package. 



with TEXT_IO, GLOBALS; 
use TEXT_IO, GLOBALS; 

package body THE_MOVE is 

procedure NNC (ELEMENT : in LIST_PTR; 

HEAD : in out LIST_PTR; 

TAIL : in out LIST_PTR) is 

Creates and maintains lists. 

begin 

if HEAD = null then 

HEAD := ELEMENT; 

TAIL := ELEMENT; 

else 

TAIL. NEXT := ELEMENT; 

TAIL := TAIL. NEXT; 

end if; 
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end NNC; 



procedure GROW_TEND (ELE : in out LIST_PTR; 

N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

Expands the search similar to that in the Tendril search. 

procedure ASSIGN (N_ARRAY : in out NODE_ARRAY; 

ELE : in out LIST_PTR; 

ROOT : in out LIST PTR) is 



begin 

if N_ARRAY (ELE.LOC(l) ,ELE.LOC(2) ,ELE.LOC(3) , 
ELE . LOC ( 4 ) ) . TEND_LEN = 0 then 
NNC (ELE, NEW_WAVE, NW_TAIL) ; 
end if; 

N_ARRAY (ELE. LOC (1) , ELE. LOC (2) , ELE. LOC (3) , 
ELE. LOC (4) ) .PARENT := ROOT. LOC; 
N_ARRAY (ELE . LOC ( 1 ) , ELE. LOC (2) , ELE. LOC (3) , 
ELE. LOC (4) ) .TENDJLEN := ELE. INC + 
N_ARRAY (ROOT. LOC (1) ,ROOT.LOC(2) ,ROOT.LOC(3) , 
ROOT . LOC ( 4 ) ) . TEND_LEN; 
if ELE. LOC = GOAL then 
GOAL_FOUND := TRUE; 
end if; 
end ASSIGN; 



begin 

if N_ARRAY (ELE. LOC (1) , ELE. LOC (2) , ELE. LOC (3) , 

ELE. LOC (4) ) .TENDJLEN = 0 then 
ASSIGN (N_ARRAY, ELE, ROOT) ; 
elsif N_ARRAY (ELE. LOC (1) , ELE . LOC (2) , ELE. LOC (3) , 
ELE . LOC ( 4 ) ) . TEND_LEN > 

(N_ARRAY (ROOT. LOC (1) , ROOT . LOC (2) , ROOT. LOC (3) , 
ROOT. LOC (4) ) .TEND_LEN + ELE. INC) then 
ASSIGN (N_ARRAY, ELE, ROOT) ; 
end if; 
end GROWJTEND; 

procedure CK_STATE (NEW_LOC : in out LOC_ARRAY; 

N_ARRAY : in out NODE_ARRAY ; 

NEW INC : in out INT TYPE; 
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ROOT : in out LIST_PTR) is 

Similar to CK_STATE in the Tendril search. 

NEW ELE : LIST PTR; 



begin 

i f N_ARRAY (NEW_LOC ( 1 ) , NEW_LOC ( 2 ) , NEW_LOC ( 3 ) , 
NEW_LOC (4) ) .STATE = 0 then 
NEW_ELE := new LIST; 

NEW_ELE . LOC ;= NEW_LOC; 

NEW_ELE . INC := NEW_INC; 

GROW_TEND (NEW_ELE, N_ARRAY, ROOT) ; 
end if; 
end CK_STATE; 

Following procedures are similar to those in the Tendril 
search ' s THE_MOVE 
package . 

procedure CHECK_N (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW_LOC : LOC_ARRAY := ROOT. LOC; 

begin 

IF NEW_LOC ( 1 ) > 1 then 

NEW_LOC ( 1 ) := NEW_L0C(1) - 1; 

CK_STATE (NEW_LOC, N_ARRAY, CARD_COST, ROOT) ; 
end if; 
end CHECK N; 



procedure CHECK_UP_N (N_ARRAY : in out NODE_ARRA Y ; 

ROOT : in out LIST_PTR) is 

NEW LOC ; LOC ARRAY := ROOT. LOC; 



begin 

IF NEW_LOC ( 1 ) > 1 and NEW_LOC(3) > 1 then 
NEW_LOC ( 1 ) := NEW_LOC ( 1 ) - 1; 

NEW_LOC ( 3 ) := NEW_L0C(3) - 1; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 
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end CHECK UP N 



procedure CHECK_DOWN_N (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW_LOC ( 1 ) > 1 and NEW_L0C(3) < MAX_DEP then 
NEW_LOC ( 1 ) := NEW_LOC ( 1 ) - 1; 

NEW_LOC ( 3 ) := NEW_LOC(3) + 1; 

CK_STATE <NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_DOWN_N; 

procedure CHECK_NE (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

NEW_LOC : LOC_ARRAY := ROOT.LOC; 

begin 

if NEW_LOC ( 1 ) > 1 and NEW_L0C(2) < MAX_COL then 
NEW_LOC ( 1 ) ;= NEW_LOC ( 1 ) - 1; 

NEW_LOC ( 2 ) := NEW_LOC ( 2 ) + 1; 

if ROOT.LOC (4) = 1 then 
NEW_LOC ( 4 ) := 2; 

else 

NEW_LOC ( 4 ) ;= 1; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 
end CHECK_NE; 

procedure CHECK_UP_NE (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW_LOC : LOC_ARRAY := ROOT.LOC; 

begin 

IF NEW_LOC ( 1 ) > 1 and NEW_LOC ( 2 ) < MAX_COL and 
NEW_LOC ( 3 ) > 1 then 

NEW_L0C(1) := NEW_LOC(l) - 1; 

NEW LOC (2) := NEW LOC (2) + 1; 
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1 ; 



NEW_LOC ( 3 ) := NEW_LOC ( 3 ) - 

if ROOT . LOC (4 ) = 1 then 
NEW_LOC ( 4 ) := 2; 

else 

NEW_LOC ( 4 ) : = 1 ; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_UP_NE ; 

procedure C HE C K_D 0 WN_NE (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW_LOC : LOC_ARRAY ;= ROOT. LOC; 

begin 

IF NEW_LOC(l) > 1 and NEW_LOC(2) < MAX_COL and 
NEW_LOC ( 3 ) < MAX_DEP then 

NEW_LOC ( 1 ) ;= NEW_LOC ( 1 ) - 1; 

NEW__LOC ( 2 ) := NEW_LOC ( 2 ) + 1; 

NEW_LOC ( 3 ) := NEW_LOC ( 3 ) + 1; 

if ROOT. LOC (4) = 1 then 
NEW_LOC ( 4 ) ;= 2; 

else 

NEW_LOC ( 4 ) : = 1 ; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_DOWN_NE; 

procedure CHECK_E (N_ARRAY ; in out NODE_ARRAY ; 

ROOT ; in out LIST_PTR) is 

NEW LOC : LOC ARRAY ;= ROOT. LOC; 



begin 

IF NEW_LOC ( 2 ) < MAX_COL then 
NEW_LOC ( 2 ) ;= NEW_LOC(2) + 1; 

CK_STATE (NEW_LOC, N_ARRAY, CARD_COST, ROOT) ; 
end if; 
end CHECK_E; 

procedure CHECK_UP_E (N_ARRAY : in out NODE ARRAY; 
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ROOT : in out LIST_PTR) is 
NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW_LOC ( 2 ) < MAX_COL and NEW_LOC(3) > 1 then 
NEW_LOC ( 2 ) := NEW_LOC(2) + 1; 

NEW_LOC ( 3 ) := NEW_LOC(3) - 1; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK UP E; 



procedure CHECK_DOWN_E (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW_LOC ( 2 ) < MAX_COL and NEW_LOC(3) < MAX_DEP 
then 

NEW_LOC ( 2 ) := NEW_LOC(2) + 1; 

NEW_LOC ( 3 ) := NEW_LOC(3) + 1; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end C HE C K_D OWN_E ; 

procedure CHECK_W (N_ARRAY : in out N ODE_ARRA Y ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY : = ROOT.LOC; 



begin 

IF NEW_LOC ( 2 ) > 1 then 

NEW_LOC ( 2 ) := NEW_LOC(2) - 1; 

CK_STATE (NEW_LOC, N_ARRAY, CARD_COST, ROOT) ; 
end if; 
end CHECK_W ; 

procedure CHECK_UP_W (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC ; LOC ARRAY := ROOT.LOC; 
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begin 



IF NEW_LOC ( 2 ) > 1 and NEW_L0C(3) > 1 then 
NEW_LOC ( 2 ) := NEW_L0C(2) - 1; 

NEW_LOC ( 3 ) := NEW_LOC ( 3 ) - 1; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_UP_W ; 

procedure CHECK_DOWN_W (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW_LOC(2) > 1 and NEW_LOC(3) < MAX_DEP then 
NEW_LOC(2) := NEW_LOC (2 ) - 1; 

NEW_LOC ( 3 ) := NEW_L0C(3) + 1; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK DOWN W; 



procedure CHECK_S (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

NEW LOC ; LOC ARRAY ;= ROOT.LOC; 



begin 

IF NEW_LOC ( 1 ) < MAX_ROW then 
NEW_LOC ( 1 ) ;= NEW_LOC(l) + 1; 

CK_STATE (NEW_LOC, N_ARRAY, CARD_COST, ROOT) ; 
end if; 
end CHECK_S; 

procedure CHECK_UP_S (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW_LOC ( 1 ) < MAX_ROW and NEW_L0C(3) > 1 then 
NEW_LOC ( 1 ) := NEW_LOC ( 1 ) + 1; 

NEW_LOC ( 3 ) := NEW_L0C(3) - 1; 

CK_STATE (NEW_LOC, N ARRAY, DIAG COST, ROOT) ; 
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end if; 

end CHECK_UP_S ; 

procedure CHECK_DOWN_S (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW_LOC ( 1 ) < MAX_ROW and NEW_LOC(3) < MAX_DEP 
then 

NEW_LOC ( 1 ) := NEW_L0C(1) + 1; 

NEW_LOC(3) := NEW_LOC ( 3 ) + 1; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_DOWN_S; 

procedure CHECK_SE (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW_LOC ( 1 ) < MAX_ROW and NEW_LOC(2) < MAX_COL 
then 

NEW_LOC ( 1 ) := NEW_LOC ( 1 ) + 1; 

NEW_LOC ( 2 ) := NEW_LOC ( 2 ) + 1; 

if ROOT.LOC (4) = 2 then 
NEW_LOC ( 4 ) := 3; 

else 

NEW_LOC ( 4 ) := 2; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 
end CHECK_SE; 

procedure CHECK_UP_SE (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW LOC ( 1 ) < MAX ROW and NEW LOC (2) < MAX COL 
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and NEW_L0C(3) > 1 then 

NEW_LOC ( 1 ) := NEW_LOC ( 1 ) + 1; 

NEW_LOC (2 ) := NEW_LOC ( 2 ) + 1; 

NEW_LOC ( 3 ) := NEW_L0C(3) - 1; 

if ROOT . LOC ( 4 ) = 2 then 
NEW_LOC ( 4 ) : = 3; 

else 

NEW_LOC ( 4 ) := 2; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_UP_SE; 

procedure CHECK_DOWN_SE (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT. LOC; 



begin 

IF NEW_LOC ( 1 ) < MAX_ROW and NEW_L0C(2) < MAX_COL 
and NEW_LOC ( 3 ) < MAX_DEP then 
NEW_LOC ( 1 ) := NEW_LOC ( 1 ) + 1; 

NEW_LOC ( 2 ) := NEW_LOC(2) + 1; 

NEW_LOC ( 3 ) := NEW_L0C(3) + 1; 

if ROOT. LOC (4) = 2 then 
NEW_LOC ( 4 ) := 3; 

else 

NEW_LOC ( 4 ) := 2; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_DOWN_SE ; 

procedure CHECK_SW (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT. LOC; 



begin 

IF NEW_LOC ( 1 ) < MAX_ROW and NEW_LOC(2) > 1 then 
NEW_LOC ( 1 ) := NEW_LOC(l) + 1; 

NEW_LOC ( 2 ) := NEW_LOC (2 ) - 1; 

if ROOT. LOC (4) = 3 then 
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NEW_LOC ( 4 ) := 4; 

else 

NEW_LOC ( 4 ) := 3; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 
end CHECK_SW; 

procedure CHECK_UP_SW (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW_LOC ( 1 ) < MAX_ROW and NEW_LOC(2) > 1 and 
NEW_LOC ( 3 ) > 1 then 

NEW_LOC ( 1 ) := NEW_LOC ( 1 ) + 1; 

NEW_LOC ( 2 ) ;= NEW_L0C(2) - 1; 

NEW_LOC ( 3 ) ;= NEW_LOC(3) - 1; 

if ROOT.LOC (4) = 3 then 
NEW_LOC ( 4 ) := 4; 

else 

NEW_LOC (4 ) := 3; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_UP_SW; 

procedure CHECK_DOWN_SW (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW_LOC ( 1 ) < MAX_ROW and NEW_LOC(2) > 1 and 
NEW_LOC ( 3 ) < MAX_DEP then 

NEW_LOC ( 1 ) := NEW_LOC ( 1 ) + 1; 

NEW_LOC (2) := NEW_LOC ( 2 ) - 1; 

NEW_LOC ( 3 ) := NEW_L0C(3) + 1; 

if ROOT.LOC (4) = 3 then 
NEW_LOC ( 4 ) ;= 4; 

else 

NEW LOC (4) := 3; 
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end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) 
end if; 

end CHECK_DOWN_SW; 

procedure CHECK_NW (N_ARRAY : in out NODE_ARRAY ; 

ROOT : in out LIST_PTR) is 

NEW_LOC : LOC_ARRAY := ROOT.LOC; 

begin 

IF NEW_LOC ( 1 ) > 1 and NEW_LOC(2) > 1 then 
NEW_LOC ( 1 ) := NEW_LOC ( 1 ) - 1; 

NEW_LOC (2 ) := NEW_LOC (2 ) - 1; 

if ROOT.LOC (4) = 1 then 
NEW_LOC ( 4 ) := 4; 

else 

NEW_LOC ( 4 ) := 1; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) 
end if; 
end CHECK_NW; 

procedure CHECK_UP_NW (N_ARRAY : in out NODE_ARRAY ; 

ROOT ; in out LIST_PTR) is 

NEW_LOC : LOC_ARRAY := ROOT.LOC; 

begin 



IF NEW_LOC ( 1 ) 
NEW_LOC ( 3 ) > 


> 1 and NEW_ 
1 then 


LOC (2) 


NEW_LOC ( 1 ) 


:= NEW_LOC ( 1 ) 


- 1; 


NEW_LOC (2) 


:= NEW_LOC (2 ) 


- 1; 


NEW LOC (3) 


:= NEW LOC (3) 


- l; 



if ROOT.LOC (4) = 1 then 
NEW_LOC ( 4 ) := 4; 

else 

NEW_LOC ( 4 ) := 1; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) 
end if; 

end CHECK UP NW; 
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procedure CHECK_DOWN_NW (N_ARRAY : in out NODE_ARRAY; 

ROOT : in out LIST_PTR) is 

NEW LOC : LOC ARRAY := ROOT.LOC; 



begin 

IF NEW__LOC ( 1 ) > 1 and NEW_LOC(2) > 1 and NEW_LOC(3) 

< 

MAX_DEP then 

NEW_LOC(l) := NEW_LOC ( 1 ) - 1; 

NEW_LOC ( 2 ) := NEW_LOC ( 2 ) - 1; 

NEW_LOC(3) := NEW_LOC ( 3 ) + 1; 
if ROOT.LOC (4) = 1 then 
NEW_LOC ( 4 ) := 4; 

else 

NEW_LOC ( 4 ) := 1; 

end if; 

CK_STATE (NEW_LOC, N_ARRAY, DIAG_COST, ROOT) ; 
end if; 

end CHECK_DOWN_NW ; 
end THE MOVE; 
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